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内 容 简 介 


本 书 是 “机 器 人 DIY 系 列 ” 之 一 ， 介 绍 了 如 何 用 价格 低廉 的 齿轮 箱 
和 电机 来 制作 双 足 步行 机 器 人 ， 并 在 有 限 的 条 件 下 使 其 逐渐 成 长 、 功 能 
更 加 完善 。 按 照 机 器 人 的 成 长 过 程 ， 本 书 分 为 6 章 : 脚 擦 地 步行 ， 直 线 前 
进 ， 直 线 前 进 、 直 线 后 退 ， 直 线 前 进 、 后 退 和 转弯 ， 用 微机 自动 控制 ， 
制作 接近 于 人 的 双 足 步行 机 嚣 人。 此 外 ， “实验: 理解 ” 栏 中 的 简单 实 
验 有 助 于 理解 双 足 步行 机 器 人 的 重心 、 支 撑 区 、 静 步行 、 动 步行 等 基本 
理论 知识 。 

本 书 可 供 机 器 人 爱好 者 阅读 ， 也 可 用 作 工 科 院 校 相关 专业 师 生 的 教 
学 用 书 。 
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要 了 解 双 足 步 行 机 器 人 的 步行 原理 , 最 好 的 办 法 是 做 一 个 这 样 的 机 器 
人 并 让 它 动 一 动 。 但 双 足 步行 机 器 人 集 材 料 、 构造 、 原 动力、 传感器 控制 、 
步行 原理 和 现代 技术 之 大 成 , 对 从 零 开 始 的 初学 者 来 说 要 越过 很 多 障碍 。 从 
这 点 来 看 , 联 杆 结构 的 机 器 人 可 以 把 很 多 步行 机 能 委托 给 联 杆 结构 , 对 于 初 
学 者 来 说 更 实际 。 

本 书 的 目的 不 是 制作 参加 比赛 的 机 器 人 , 而 是 以 制作 结构 简单 的 双 足 步 
行 机 器 人 来 理解 双 足 步行 的 理论 基础 。 因 此 , 动作 优美 的 切 比 雪夫 联 杆 结 
构 和 平行 杠杆 组 合 而 成 的 脚 , 可 以 用 价格 低廉 的 齿轮 箱 和 电机 来 制作 , 并 作 
为 本 书 的 基本 硬件 。 对 初次 制作 者 来 说 , 如 果 能 做 到 加 工 正确 , 即使 是 一 张 
塑料 板 , 通过 变形 也 可 成 为 双 足 步行 机 器 人 , 从 而 能 体会 到 步行 的 乐趣 。 另 
外 , 为 了 使 初学 者 能 根据 自身 情况 进行 双 足 步行 的 实验 , 本 书 采取 了 在 每 个 
阶段 都 让 机 器 人 成 长 的 形式 。 最 后 , 虽然 采用 了 微机 控制 , 但 传感器 和 电机 
末端 的 前 置 放大 器 是 自制 的 , 这 正 是 目前 作为 双 足 步行 机 器 人 标准 的 伺服 电 
机 原理 。 由 于 脚 的 动作 依靠 联 杆 , 所 以 用 自制 的 伺服 电机 也 可 进行 控制 ,对 
于 想 了 解 按 程序 步行 的 双 足 步行 机 器 人 的 人 来 说 , 一 定 要 试 一 试 。 

在 每 章 的 “实验 : 理解” 栏 里 , 虽然 都 是 些 简单 的 实验 , 但 同时 也 与 双 
足 步行 机 器 人 密切 相关 。 特别 是 第 2 章 的 重心 实验 和 第 6 章 的 动 步行 实验 ， 
请 一 定 要 “实验 :理解 ”一 下 。 

另外 , 在 制作 中 特别 要 注意 安全 。 当 尺寸 对 不 上 时 , 即使 多 次 重 做 , 也 不 
要 因 心 急 而 碰 伤 。 

当 看 着 自己 辛 辛 苦 苦 制作 出 的 机 器 人 时 , 一 定 会 充满 爱 意 、 不 由 自主 地 
想起 个 名 字 吧 ? 用 这 样 的 机 器 人 一 边 进 行 着 各 种 实验 , 一 边 思 考 着 步行 的 结 
构 原 理 , 从 此 便 踏 入 了 双 足 步行 机 器 人 的 世界 里 。 

最 后 , 对 在 本 书 执笔 之 际 给予 大 力 协作 的 ohnmsha 的 各 位 , 在 此 深 表 谢 
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本 书 以 在 第 1 章 中 制作 的 双 足 步行 机 器 人 为 基础 , 然后 按照 后 续 每 章 使 
机 器 人 成 长 的 。 因 此 , 可 以 在 每 章 中 停 下 来 休息 片刻 , 在 欣赏 机 器 人 步行 实 
验 的 同时 , 也 可 以 学 习 双 足 步行 的 基本 原理 。 


参考 人 的 双 足 步 行 , 分 析 步 行 的 原理 , 制作 双 足 步行 的 机 器 人 。 把 拾 肝 ， 
向 前 迈步 这 样 的 动作 ,通过 1 个 电机 和 联 杆 结构 实现 。 虽说 是 简单 的 机 器 人， 
但 可 以 在 实验 中 看 到 机 器 人 边 左右 转动 身体 边 双 足 行走 的 样子 . 


图 1 在 第 1 章 中 制作 的 双 足 步行 机 器 人 边 左 右 转 动身 体 边 双 足 行走 
在 第 1 章 中 制作 的 脚 , 可 一 直 用 到 第 5 章 , 故 以 后 每 章 不 必 从 脚 开始 制作 。 
第 2 章 
增加 重心 移动 的 结构 。 力 求 简单 ,不 增加 电机 , 而 是 想 办 法 在 联 杆 结构 上 


使 重心 移动 。 实现 了 能 抬 脚 , 向 前 迈步 的 步行 基本 功能 , 并 切实 感受 到 了 改善 
后 的 直线 前 进 。 


图 2 ”在 第 2 章 中 制作 的 双 足 步行 机 器 人 在 直线 前 进 上 得 到 了 改善 


为 了 使 重心 移动 , 增加 了 一 个 电机 , 也 可 进行 遥控 了 。 重心 移动 采用 了 使 上 
身 倾斜 的 方法 , 在 实验 中 可 以 看 到 把 重心 放 到 一 只 脚 上 的 各 种 样子 。 


图 3 在 第 3 章 中 制作 的 双 足 步行 机 器 人 的 重心 移动 可 以 进行 遥控 


从 第 3 章 的 实验 结果 可 以 看 出 , 机 器 人 似乎 可 以 转弯 。 所 以 , 一 边 进行 前 
进 和 后 退 , 一 边 进行 左右 转弯 的 实验 , 使 机 器 人 成 长 为 能 够 前 进 、 后 退 和 转 
弯 的 双 足 步行 机 器 人 。 


第 5 章 

搭载 微机 。 在 制作 上 , 有 电子 零件 的 焊接 和 程序 调试 等 等 , 难度 稍微 高 
一 些 , 但 机 器 人 成 长 为 能 按 程序 行走 的 双 足 步行 机 器 人 了 。 

电机 和 旋转 传感器 的 组 装 也 力求 在 制作 上 简单 化 , 所 以 其 原理 比较 容 
易 理解 。 


第 6 章 

对 本 田 ASIMO 那 样 高 难度 的 双 足 步行 机 器 人 及 市 场 上 销售 的 昂贵 双 足 
步行 机 器 人 所 采用 的 稍 高 水 平 双 足 步行 理论 的 基础 部 分 进行 了 简要 说 明 ， 
对 于 想 挑战 各 种 机 器 人 的 制作 者 来 说 可 以 参考 . 


试验 .理解 

每 章 根据 需要 设 有 “试验 :理解 ”, 虽然 尽 是 些 用 厚 纸 做 人 形 的 简单 实 
验 , 但 如 果 要 学 习 双 足 步行 机 器 人 理论 的 话 , 一 定 会 有 重心 . 支撑 区 、 BEA 
和 动 步行 这 样 的 基本 知识 , 通过 这 样 的 实验 可 以 对 这 些 知 识 加 以 理解 。 
(iv) 本 书 的 欣赏 方法 


第 1 章 ” 脚 控 地 步行 
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二 和 人 


在 第 1 章 ， 将 要 制作 双 足 擦 地 步行 的 机 器 人 。 我 们 边 分 析 人 步行 
时 的 动画 摄影 ， 边 思考 双 足 步行 机 器 人 的 结构 。 考 虑 到 要 使 初学 者 
也 能 制作 出 易 控 制 、 花 费 低 、 制 作 过 程 简单 的 双 足 步行 机 器 人 ， 所 
以 在 制作 时 减少 了 电机 的 数量 ,采用 了 联 杆 结构 。 在 第 1 章 中 制作 的 
脚 ， 以 后 各 章 都 要 继续 使 用 。 每 章 都 会 让 机 器 人 成长 ， 最 终 成 为 能 
直 进 、 后 退 和 转弯 的 双 足 步行 机 器 人 。 


在 第 1 章 制 作 的 脚 ， 将 是 以 后 各 章 的 基础 ， 所 以 请 务必 正确 地 制 
作 。 | 


4 2 Sie RRIF 
1.1 人 的 步行 分 析 


在 地 球 上 , 能 用 双 足 自由 活动 的 生物 是 什么 ? 对 , BA. 无 论 其 他 任何 
动物 还 是 高 性 能 的 双 足 步行 机 器 人 , 其 步行 都 远 远 不 及 人 ,。 持续 步行 数 百 万 
年 的 人 类 是 双 足 步行 者 的 老 前 辈 。 在 制作 双 足 步行 机 器 人 之 前 , 先 让 我 们 观 
察 一 下 人 的 步行 情况 。 

图 1.1 是 把 人 步行 时 的 姿势 摄影 后 又 剪辑 而 成 的 连续 静止 画像 。 为 了 便 
于 理解 , 把 步行 时 的 动作 稍微 夸大 了 一 些 。 


图 1.1 ”从 人 的 步行 摄影 中 , HE A 


仔细 看 一 看 图 1.1, 分 析 人 的 双 足 步行 情况 : 


San eae 
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S 


th 


弯曲 方法 、 腹 臂 的 摆动 方法 、 后 足 的 足 地 方法 等 等 。 如果 有 时 间 , 也 可 以 对 
快走 和 跑步 进行 动画 摄影 , 自己 进行 分 析 一 定 更 有 意思 。 


1.2 脚 的 结构 3 


1.2 脚 的 结构 


让 我 们 以 前 节 中 对 人 的 步行 分 析 为 基础 考虑 一 下 脚 的 结构 吧 。 

为 了 让 机 器 人 实现 人 的 步行 姿势 , 在 足 部 的 可 动 部 位 可 考虑 用 电机 来 蔡 
换 。 这 样 , 膝盖 上 、 腰 上 等 部 位 也 要 放 上 电机 , 需要 的 电机 数量 很 多 , 如 图 
1.2 所 示 ; 所 需 的 费用 相应 也 大 , 并 且 对 各 个 电机 的 控制 也 变 得 复杂 起 来 , 这 
对 初学 者 来 说 , 需要 越过 的 门槛 也 增多 了 。 

为 此 , 要 理解 步行 原理 就 应 尽量 减少 电机 的 数量 , 制作 简单 、 费 用 低 的 
双 足 步行 机 器 人 。 


图 1.2 电机 的 数量 很 多 


为 了 能 在 减少 电机 数量 的 情况 下 实现 步行 动作 , 这 里 采用 联 杆 结构 。 

联 杆 结构 应 用 于 各 种 产品 中 , 比如 掘 土 机 。 其 中 有 一 种 名 叫 切 比 雪 
夫 的 联 杆 结构 。 也许 你 没有 听 到 过 此 名 , 但 在 《机 器 人 竞赛 杂志 》No.57 

(ohmsha 发 行 )《 用 LEGO MINDSTORMS (RER) 》 中 便 使 用 
了 由 切 比 雪夫 联 杠 结构 和 平行 杠杆 组 合 后 的 结构 , 我 想 一 定 有 不 少 人 看 到 过 
E? 在 双 足 步行 机 器 人 格斗 竞技 大 会 ROBO-ONE 第 一 次 大 会 上 获胜 的 机 器 
ASTA-17” 的 脚 , 也 使 用 了 这 种 结构 。 

这 种 结构 如 图 1.3 所 示 。 深 色 部 分 为 切 比 雪夫 联 杆 结构 , 浅 色 部 分 是 平 
行 杠 杆 结构 。 因 各 杆 都 是 联 杆 , 所 以 又 称 为 “ 节 ”。 切 比 雪夫 联 杆 结构 是 由 
原 动 节 、 静 止 节 、 中 间 节 、 延长 中 间 节 及 从 动 节 组 成 , 原 动 节 的 转动 可 使 中 间 
节 、 延长 中 间 节 、 从 动 节 进 行规 定 的 动作 。 如果 把 原 动 节 的 长 度 比 作 1, 其 他 
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各 节 的 长 度 则 见 表 1.1。 


图 1.3 切 比 雪夫 联 杆 结构 


R11 切 比 雪夫 联 杆 结 构 
各 节 的 长 度 比 


原 动 节 1 
静止 节 2 
从 动 节 2.5 
中 间 节 2.5 
延长 中 间 节 2.5 


如 果 把 图 1.3 的 结构 用 作 机 器 人 的 脚 , 则 切 比 雪夫 联 杆 结构 ( 深 色 部 分 ) 
负责 把 脚 抬 起 并 向 前 迈 出 的 动作 , 而 平行 杠杆 结构 (白色 部 分 ) 则 使 脚面 与 
地 面 保持 平行 。 这 种 结构 的 动作 情况 可 用 图 1.4 来 表示 。 


®© © ©) @ © © 


图 1.4 切 比 雪夫 联 杆 结构 与 平行 杠杆 结构 组 合 的 动作 


和 图 1.3 比 一 比 便 明白 , 由 于 原 动 节 的 转动 , 使 中 间 节 、 延长 中 间 节 、 从 动 
节 按 规定 的 动作 运作 。 再 者 , 想必 大 家 一 定 注意 到 了 , 平行 杠杆 部 分 使 和 延 
长 中 间 节 相连 接 的 脚面 与 地 面 保持 平行 。 与 图 1.1 中 右 脚 的 动作 对 应 起 来 看 
-m 
图 1.4 的 @ 一 @ 是 脚 向 前 迈 出 的 动作 , @ 是 脚 着 地 的 动作 , © ~ @ 则 是 脚 
落 在 后 边 时 的 样子 。 
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在 本 书 中 制作 的 双 足 步行 机 器 人 的 脚 将 采用 切 比 雪 夫 联 杆 结构 , 在 双 
脚 上 配置 切 比 雪夫 联 杆 结构 后 的 形象 如 图 1.5 所 示 。 使 原 动 节 转动 , 其 他 节 
(杠杆 ) 就 可 按 规定 的 动作 运作 , 做 出 图 1.4 那 样 的 步行 动作 。 


使 原 动 节 转 动 


图 1.5 两 脚 的 切 比 雪夫 联 杆 结构 


= 


我 们 来 确定 图 1.5 中 切 比 雪夫 联 杆 结构 中 , 使 原 动 节 转动 的 原动力 。 

通常 把 发 生动 力 的 装置 称 为 往复 运动 汽缸 , 但 这 里 用 直流 电机 作为 使 
原 动 节 转 动 的 原动力 。 在 往复 运动 汽缸 中 还 有 气压 缸 和 油 压 人 缸 等 等 , 其 对 
运动 的 机 器 人 来 说 是 不 可 缺少 的 要 素 。 

直流 电机 也 是 被 经 常 使 用 的 动力 , 但 如 果 直 接 使 用 的 话 , 转速 过 快 , 一 
般 用 齿轮 进行 减速 。 

本 书 中 的 机 器 人 用 田 宫 的 4 速 曲柄 齿轮 箱 作为 减速 齿轮 。 此 齿轮 箱 的 减 
速 比 可 以 从 126 :1 的 高 转速 到 5402 :1 的 高 力矩 低 转速 进行 4 种 选择 , 非常 方 
E. 另外 , 这 种 齿轮 箱 附带 有 曲柄 杆 , 可 以 作为 切 比 雪夫 结构 的 原 动 节 使 用 ， 
如 图 1.6 所 示 。 

在 此 处 , 用 于 原 动 节 的 曲柄 结构 可 以 把 转动 变 成 往复 直线 运动 , 也 
可 反 过 来 把 往复 直线 运动 变 成 转动 , 是 经 常 被 使 用 的 一 种 结构 。 本 书 中 
要 制作 的 双 足 步行 机 器 人 ,需要 把 原 动 节 的 转动 变 成 中 间 节 的 往复 运 
动 。 

在 第 1 章 中 使 用 于 脚 的 减速 齿轮 , 其 减速 比 为 441 : 1, 请 参考 组 装 说 明 
书 , 按 4 速 曲柄 齿轮 箱 的 B 型 进行 组 装 。 
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曲柄 杆 


曲柄 杆 


bee sa 


16.5mm k 


电机 


图 1.6 田 宫 4 速 曲柄 齿轮 箱 


在 说 明 图 1.3 所 示 切 比 雪夫 联 杆 结构 时 曾 说 过 , Bo, 固定 节 、 从 动 
节 、 中 间 节 、 延长 中 间 节 的 各 个 长 度 之 间 都 存在 一 定 的 关系 。 

本 书 中 的 机 器 人 , 把 4 速 曲 柄 齿轮 箱 所 附带 的 曲柄 杆 用 于 切 比 雪 夫 联 杆 结构 
的 原 动 节 。 测定 一 下 , 它 的 长 度 为 16.5mm。 原 动 节 的 长 度 一 旦 确定 , 其 他 节 (AT 
杆 ) 的 长 度 便 能 确定 下 来 , 机 器 人 脚 的 尺寸 也 可 确定 下 来 。 

本 书 中 制作 的 双 足 步行 机 器 人 的 各 节 (杠杆 ) 的 长 度 见 表 1.2, 请 再 次 和 
图 1.3 一 图 1.5 比 较 。 


表 1.2 本 书 中 制作 的 双 足 步行 机 器 人 的 各 节 的 长 度 


原 动 节 


静止 节 33mm 


1 
静止 节 2 
从 动 节 2.5 从 动 节 41.25mm 
中 间 节 2.5 中 间 节 41.25mm 
延长 中 间 节 2.5 延长 中 间 节 41.25mm 


1.3 基础 脚 的 制作 


确定 脚 的 结构 后 便 是 加 工 制作 , 首先 要 确定 使 用 何 种 材料 。 在 第 1 章 制 
作 脚 时 所 需要 的 材料 见 表 1.3。 笔者 当初 使 用 的 是 丙烯 材料 , 但 丙烯 材料 脆 
性 大 、 不 易 加 工 , 开 孔 时 经 常 因 材 料 破裂 而 失败 。 后 来 使 用 了 名 为 ABS 的 材 
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料 , 它 是 塑料 的 一 种 , 易 加 工 、 价格 适 中 , 也 有 足够 的 机 械 强 度 , 手感 比 丙 烯 柔软 。 也 
许 你 会 有 些 不 安 , 但 请 放心 使 用 : 若是 一 张 平板 , 很 容易 弯曲 ; 但 做 成 立体 结构 的 
话 , 就 有 足够 的 强度 , 完全 可 以 用 作 脚 的 材料 (请 参考 图 1.7 及 “实验 .理解 : 形状 和 
强度 ”) 。 使 用 ABS 材 料 的 最 大 理由 还 是 易于 加 工 , 如 果实 在 需要 提高 强度 的 话 , 也 
可 以 使 用 一 部 分 铝 。 金属 ! 请 不 要 吃惊 , 只 是 很 薄 的 铝 片 , 不 难 加 工 。 


图 1.7 在 形状 上 想 办 法 增加 强度 


表 1.3 在 第 1 章 制作 脚 时 所 需要 的 材料 


ABS 板 330x245, 厚 2.0mm 1 东 急 HANDS 

方形 铝 管 Im, 10x10x1.0 (A6063) 1 东 急 HANDS 620 
fata Im, 12x12x1.2 (A6063) 1 东 急 HANDS 370 
支撑 柱 $3.1x22 2 铃 商 10 
M3 螺钉 M3x30 16 商店 a 5 
M3 螺钉 M3x12 10 商店 5 
M3 螺母 M3 28 商店 5 
区 MEE s 
ABS 烙 接 剂 1 东 急 HANDS 203 
田 宫 齿轮 箱 4 速 曲柄 齿轮 箱 1 模型 店 570 
黄 铜 圆 杆 $3x300mm 1 商店 100 
PHAN BMS 3 号 x2 节 1 秋月 电子 通商 60 


其 次 是 加 工 方法 。 如 果 是 在 工业 职业 高 中 或 大 学 的 工学 部 , 制作 器 械 和 
测量 工具 齐全 , 本 书 的 机 器 人 可 精确 、 短 时 间 地 制作 出 来 。 然 而, 本 书 的 目的 
就 是 在 不 具备 制作 环境 的 业余 条 件 下 也 要 能 制作 出 双 足 步行 机 器 人 。 因此 , 让 我 们 


> 
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用 商店 里 能 买 到 的 工具 来 制作 双 足 步行 机 器 人 , 如 图 1.8~1.10 所 示 。 


| 
| 
| 用 塑料 切断 刀 切 断 ABS。 
| 直线 切断 时 要 使 用 尺子 。 
上 尺子 可 以 是 铝 制 的 ， 也 可 以 是 钢 制 的 。 
图 塑料 切断 刀 ' 
Sa ， 用 铂 乌 夫 切断 后 的 毛刺 。 


按 曲线 加 工 ABS 时 ， 先 用 剪 钳 剪 去 带 
AHRR, FHF. 


虎 钳 是 剪断 铝 材 和 开 孔 时 是 必 不 可 少 
的 工具 。 因 为 加 工 的 铝 材 较 薄 ， 可 购 
买 较 便宜 的 虎 钳 。 


Meet ( 台式 虎 钳 ) 


用 电钻 在 ABS 和 锅 材 料 上 开 孔 。 

使 用 的 钻头 直径 为 3mm、3.2mm 、 
4mm、6mm 、8mm， 使 用 时 注意 不 要 
碰 伤 。 另 外 ， 开 6mm 以 上 的 孔 时 ,用 
IRETI (3 ~ 10mm ) 比较 安全 。 


A 
g 


1 
1 
| 
| 
国电 钻 “ 底盘 饺 刀 
p 
| 为 了 使 孔 的 位 置 准确 ， 开 孔 前 可 用 此 
! 工具 在 开 孔 处 打上 记号 。 
! 把 中 心 打 孔 机 的 尖端 对 准 要 打 孔 的 位 
! 置 ， 再 用 锤子 打上 记号 。 
图 中 心 打 孔 机 | 
4. 
| 
! 自动 打 孔 机 比 中 心 打 孔 机 的 价格 高 ， 
! 但 使 用 方便 。 
! 
图 自动 打 孔 机 ' 
ae 


图 1.9 用 于 打 孔 的 工具 
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' 
! 专用 粘 接 剂 ， 易 粘 接 ABS。 


BABSKA] 


图 1.10 ” 粘 接 剂 


脚 的 制作 顺序 如 图 1.11 所 示 。 

@ 设 计 : 确定 脚 用 零件 的 形状 和 尺寸 , 并 在 图 纸 上 表 示 出 来 。 

OWA: 在 材料 上 , 按 图 纸 尺寸 画 出 开 孔 位 置 和 要 切断 的 部 位 。 

OMI (FFL, WW) : 按照 划 线 位 置 , 在 要 开 孔 的 地 方 用 打 孔 机 打印 后 
FFL, 在 要 切断 的 部 位 用 塑料 切断 刀 或 金属 锯 切 断 。 

@ 和 零件 制作 : 把 切断 的 材料 用 粘 接 剂 粘 接 , 制作 所 需要 的 零件 数 。 

CARFE: 把 各 个 零件 组 装 成 脚 。 


> RUA HT 


上 制作 零件 


| 组 装 零件 


图 1.11 制作 顺序 
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制作 的 要 点 是 加 工 要 准确 , 如 图 1.12 所 示 。 肢 是 零件 的 汇集 处 , 要 使 做 
出 的 脚 能 够 圆滑 地 动作 , 各 个 零件 的 加 工 尺 寸 必须 准确 ,为 此 , 在 上 述 的 各 
个 流程 中 要 慎重 作业 。 


孔 的 位 置 准 确 的 话 ， 孔 的 位 置 不 准确 时 ， 
将 与 轴 成 直角 。 将 与 轴 不 成 直角 ， 弯 曲 着 。 


图 1.12 零件 的 加 工 要 准确 


要 制作 的 零件 如 图 1.13 所 示 。 SHEA, 零件 B、 零件 C、 零件 D、 零件 E 分 
别 制作 2 个 , 也 就 是 左 、 右 两 只 脚 的 零件 。 


-G n & 
RN 
A E 4 
FND 
) ) ) G 4 
零件 A 零件 B 零件 C B A 2 
2 个 2s pA he 
B 2 
= < F 4 
S 
XDD 7 7 
is) 
2 
零件 D 零件 E D $ 
2 个 2 个 D 2 
F 4 
E C 4 
H 4 


图 1.13 ”制作 零件 的 种 类 及 材料 明细 


1. 划 线 加 工 
第 1 步 , 制作 组 成 这 些 零件 的 材料 : 材料 A 6 个 , 材料 B 2 个 , 从 ABS 板 中 剪 切 出 
图 1.14 的 材料 。ABS 板 的 尺寸 为 长 330mmx 宽 24Smm, 按 图 1.14 配 置 后 划 线 。 
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把 相同 宽度 的 材料 统一 配置 后 , 材料 在 宽度 方向 的 尺寸 误差 将 会 减少 
划 线 时 , 尽量 用 细 铅 笔 或 圆珠笔 , 记号 笔 的 线 太 粗 , 易 产生 误差 。 


尺寸 的 单位 是 mm， 
以 后 也 一 样 。 


图 1.14 ”材料 A 和 B 的 尺寸 及 配置 图 


把 材料 A 和 材料 B 在 ABS 板 上 划 线 后 切断 。 ABS 板 上 并 没有 把 所 有 的 
材料 都 划 线 , 这 是 因为 塑料 切断 刀 是 有 厚度 的 。 笔者 手头 的 切断 刀 厚 度 为 
0.6mm, 如 果 按 图 1.14 划 线 再 用 切断 刀 切 断 , 材料 的 尺寸 就 会 减少 0.6mm。 
不 受 此 误差 影响 的 部 分 是 图 1.14 配 置 图 中 的 虚线 部 分 , 而 实 线 部 分 会 因 这 
个 误差 影响 零件 的 精度 。 

因此 , 先 把 第 1 列 的 材料 划 线 、 切 断 (需要 开 孔 的 材料 开 孔 后 再 切断 ) ， 
再 将 第 2 列 的 材料 划 线 、 切 断 。 按 此 顺序 对 材料 进行 加 工 。 

切断 时 , 用 尺子 对 准 材 料 上 的 划 线 , 不 要 忘记 了 切断 刀 的 厚度 , 如 图 1.15 
所 示 。 


塑料 切断 刀 的 刀片 


ABS 板 


注意 0.6mm 的 厚度 
图 1.15 切断 刀 的 厚度 


» 
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把 塑料 切断 刀 沿 着 尺子 切 下 去 。 因 ABS 板 和 尺子 容易 滑动 , 只 用 手 按 住 
的 话 很 难 固定 。 按 图 1.16 所 示 在 尺子 的 背面 贴 上 双 面 胶 , 这 样 就 不 易 滑 动 。 


贴 双 面 胶带 


图 1.16 ”在 尺子 的 背面 贴 上 双 面 胶带 


再 者 , 塑料 切断 刀 相 对 于 材料 而 言 要 垂直 竖立 , 如 图 1.17 所 示 。 如 果 不 
这 样 的 话 , 切断 面 将 是 斜面 。 


直角 


图 1.17 塑料 切断 刀 要 成 直角 


把 塑料 切断 刀 沿 着 尺子 切 划 十 几 次 ,一 点 一 点 地 切断 , 如 图 1.18 所 示 。 


如 此 ， 一 点 一 点 地 切断 。 


图 1.18 一 点 一 点 地 切断 
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用 塑料 切断 刀 切 几 次 后 , BRA VA FE A ARA, 但 这 样 会 造成 
断面 参差 不 齐 , 影响 精度 。 在 特别 要 求 精度 的 部 位 , NT, 而 要 用 
切断 刀 切 断 。 

切断 后 , 再 用 铁 除 去 毛刺 。 如 图 1.19 所 示 , 用 左手 拿 住 材料 , 右手 握 住 
ok, 轻 轻 地 雏 有 毛刺 的 部 位 , 注意 用 力 要 适当 。 


图 1.19 去 毛刺 


第 2 步 , 加 工 6 个 材料 C 和 2 个 材料 D。 按 图 1.20 所 示 的 尺寸 把 材料 配置 
后 , ABS LBA, 切断 时 要 考虑 塑料 切断 刀 的 厚度 。 


MAD |o a 
2 个 = zZ 
g| 

=| 

18 x z 
z 

Q 

ae ae 
=| 

m 

z 

材料 C a g| 
s |R $ 
a 

x 

Er 

a 

E z 
18 = 


图 1.20 ”材料 C 和 D 的 尺寸 及 配置 图 


第 3 步 , 加 工 4 个 材料 EE, 按 图 1.21 在 ABS 板 上 配置 后 划 线 。 切 断 时 要 考 
虑 切断 刀 的 厚度 。 
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第 4 步 , 制作 材料 F、G、H。 图 1.22 中 的 记号 “$3” 是 “直径 3mm 的 孔 ” 的 
意思 , 这 次 将 在 材料 F、G、H 上 开 孔 。 按 尺 寸 线 划 线 后 先 开 孔 再 切断 。 因为 材 
料 很 小 , 切断 后 开 孔 是 很 危险 的 。 在 开 孔 位 置 上 ， 线 和 线 是 交叉 的 , 在 交叉 
点 上 用 打 孔 机 打上 记号 。 如果 打 的 记号 位 置 不 准确 ， 那么 孔 的 位 置 也 就 错位 
T, 所 以 一 定 要 慎重 地 进行 。 
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图 1.21 材料 E 的 尺寸 及 配置 图 
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在 开 孔 位 置 上 线 是 交差 的 ， 


一 SE: 在 交点 上 用 打 孔 机 打上 记号 。 
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材料 下 的 尺寸 材料 G 的 尺寸 
图 1.22 材料 F 和 G 的 尺寸 及 配置 
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图 1.23 是 自动 打 孔 机 的 使 用 例子 。 一手 握 住 自动 打 孔 机 , 对 准 孔 的 位 
置 , 另 一 手 往 下 按压 后 便 打 上 了 记号 。 中心 打 和 孔 机 的 使 用 方法 与 自动 打 孔 机 
大 致 相同 , 只 是 打 孔 时 不 是 用 手 按压 的 , 而 是 用 锤子 , 轻 轻 地 殴打 一 次 就 打 
出 了 记号 。 如 果 用 丙烯 板 的 话 , 此 种 情况 下 极 易 出 现 裂纹 或 破碎 ; ABS 材 料 
便 不 会 出 现 这 种 现象 ; 背面 上 或 许 会 留 下 少许 痕迹 , 但 还 要 接着 用 销 头 开 
孔 , 所 以 不 受 影响 。 

把 %3 的 销 头 对 准 打 孔 机 打上 记号 的 地 方 , 钻 要 垂直 竖立 , 要 感觉 到 锁 
头 是 自然 进入 到 记号 坑 里 的 。 右手 拿 住 销 , 左手 用 力 按 住 材料 板 ， 以 免 钻 清 
动 时 受伤 。 


图 1.23 用 打 孔 机 打 记 号 


连续 3 次 按照 图 1.22 所 示 材 料 F 和 材料 G 的 配置 在 ABS 板 上 划 线 、 切 断 。 
这 样 , 便 制 作出 12 个 材料 F 和 3 个 材料 G。 

材料 H 按 图 1.24 的 尺寸 , 材料 G 按 图 1.22 的 尺寸 , 按 图 1.24 配 置 , 在 ABS 板 上 划 
线 后 切断 。 这 样 , 加 工 出 的 材料 H 为 4 个 , 材料 G 加 上 前 次 加 工 的 共 4 个 。 

由 于 还 需要 1 个 材料 G, 再 按 图 1.22 的 尺寸 划 线 加 工 即 可 。 

第 5 步 , 加 工 制作 齿轮 箱 的 盖子 , 如 图 1.25 所 示 。 KARRAR o 9 的 孔 是 
很 危险 的 , 所 以 不 要 开 孔 , 直接 用 塑料 切断 刀 把 图 上 的 实 线 部 分 切 掉 。 这 一 部 分 不 
要 求 精度 , 只 要 能 把 齿轮 箱 的 轴 的 突起 部 位 垦 入 进去 就 可 以 了 。 

ON RA VEE EE BOT, 先 用 销 开 43 的 底 孔 , 再 用 底盘 匀 刀 把 孔 扩 大 到 9。 用 外 
打 孔 时 , 如 果 不 把 材料 用 力 按压 住 的 话 , 钻头 就 会 卷 起 材料 , 这 是 很 危险 的 。 因 
此 , 最 好 请 一 位 成 年 人 帮助 用 力 按压 住 , 或 用 虎 钳 把 ABS 板 固定 后 再 打 孔 。 

另外 , 从 ABS 板 上 切 下 之 前 , 要 先 打 孔 , 再 按照 尺寸 正确 地 切断 。 如 果 
先 切断 的 话 , ABSA RT RB, 很 难 用 虎 钳 压 住 , 也 就 无 法 开 孔 了 。 

把 2 个 孔 都 增加 到 $9 后 , 再 用 塑料 切断 刀 沿 实 线 部 分 反复 切割 。 加 3、 
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$4、 $3.2 筷 的 位 置 必须 要 准确 , 由 于 其 位 置 是 很 复杂 的 , 可 以 先 用 打 孔 机 
把 位 置 固定 。 一 定 要 注意 安全 。 
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图 1.24 材料 也 的 尺寸 和 配置 
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图 1.25 齿轮 箱 盖子 的 尺寸 


2. 制 作 零件 
在 制作 零件 时 , 即便 打 孔 、 切 断 是 很 准确 的 , 但 粘 接 时 偏 余 的话 , 孔 的 
位 置 也 会 偏 斜 。 请 再 看 一 看 图 1.12。 
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为 了 不 使 孔 的 位 置 偏 斜 , 粘 接 材料 (图 1.26) 时 , 请 准备 图 1.27 那 样 的 

模型 ,对照 模型 进行 粘 接 , 特别 是 在 ABS 材 料 上 划 的 孔 的 中 心 线 要 和 模型 

纸 上 的 中 心 线 完全 对 合 。 配置 并 粘 接 材 料 是 在 模型 纸 上 进 行 的 , 材料 摆 放 


图 1.26 粘 接 材料 , 制作 脚 部 零件 


孔 的 中 心 线 模型 纸 的 线 


图 1.27 模型 纸 的 线 和 和 孔 的 中 心 线 要 对 准 


如 图 1.28 所 示 , 把 侧面 的 板 在 模型 纸 上 立 起 后 , 再 对 照 模型 纸 上 的 线 放 
上 正面 板 。 按 这 种 方法 摆好 后 , 粘 接 所 有 的 侧面 板 , 如 图 1.29 所 示 。 
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图 1.29 在 侧面 板 和 正面 板 粘 接 好 


图 1.28 在 材料 C 上 粘 接 材料 F 
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如 图 1.30 所 示 , 在 另 一 侧 把 粘 接 用 板 按照 模型 纸 上 的 线 放置 , 再 把 刚才 
粘 接 完了 的 一 组 板 倒 扣 着 放 到 新 板 上 面 。 为 了 不 使 放 在 模型 纸 上 的 板 悬 空 ， 
要 用 切断 刀 按 着 粘 接 。 


放 人 的 板 不 要 
在 里 面 悬 空 


图 1.30 ”在 另 一 侧 放 置 粘 接 板 


从 侧面 可 以 看 出 , 像 零件 D 和 零件 E 一 样 , 放 入 里 侧 的 板 的 位 置 也 有 不 
同 , 粘 接 时 要 仔细 看 清楚 模型 纸 , 不 要 把 尺寸 和 位 置 搞 错 了 。 全 部 粘 接 完了 
后 的 零件 如 图 1.31 所 示 。 


图 1.31 粘 接 完 了 
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制作 好 的 零件 有 楼 角 , 但 组 装 成 脚 后 有 时 会 触 磁 别 的 东西 , 所 以 最 好 用 
剪 钳 切 去 单 侧 4 个 、 双 侧 8 个 楼 角 , 如 图 1.32 所 示 。 如 果 想 使 棱角 成 圆 弧 状 的 
话 , 再 用 雏 刍 成 圆 形 即 可 。 
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图 1.32 用 剪 钳 切 去 棱角 


图 1.33 是 粘 接 用 的 模型 纸 , 和 实际 尺寸 一 样 大 小 , 可 以 复印 后 使 用 。 应 
注意 的 是 , 零件 A 的 模型 只 有 1 个 , 但 实际 零件 是 2 个 ; 零件 E 的 侧面 所 用 的 板 
不 是 带 有 2 个 孔 的 材料 F, 而 是 带 有 4 个 孔 的 材料 HH。 

接 下 来 , 加 工 铝 材料 制作 零件 。 铝 比 ABS 硬 , 但 用 虎 钳 固定 牢固 后 还 是 
可 以 加 工 的 。 

加 工 零件 F 时 , 把 方 管 铝 材 固定 在 虎 钳 上 , 用 钢 锯 按 71.25mm 的 长 度 锯 
成 2 根 。 钢 饥 是 在 推 的 时 候 切 割 , 和 木工 用 锯 相 反 , 这 点 请 注意 。 

划 打 和 孔 的 中 心 线 。 材 料 F 在 表面 上 有 3 个 孔 , 背面 上 有 4 个 , 共 7 个 孔 。 表 
面 和 背面 的 3 个 孔 的 位 置 是 一 致 的 。 像 材料 F 这 样 的 小 零件 要 固定 在 虎 钳 上 
划 线 。 

在 打 孔 位 置 用 打 孔 机 打上 记号 的 地 方 , 再 用 $3 销 头 打 孔 。 图 纸 上 标 有 
$8 的 孔 , HCHO 3 钻头 打 孔 。 打 孔 时 , 要 把 零件 F 在 虎 钳 上 固定 结实 以 后 
进行 , 钻头 要 垂直 , 如 图 1.34 所 示 。 打 孔 顺序 如 图 1.35 所 示 。 

零件 F 还 需要 进行 切割 加 工 。 图 1.36 中 , 在 零件 F 上 标 有 28mm 的 部 位 要 
用 钢 锯 切 割 。 加 工 好 的 零件 F 如 图 1.37 所 示 。 
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图 1.33 ” 粘 接 用 模型 纸 的 尺寸 
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图 1.34 固定 在 老虎 钳 上 打 孔 


(a) 在 背面 开 8 个 3 的 孔 (b) 用 %6 和 %8 的 钻头 把 (e) 在 背面 ， 用 %6 和 %8 的 钻头 把 
9%3 的 孔 增加 到 乡 8 3 个 $3 的 孔 增 加 到 98 


图 1.35 零件 F 的 打 孔 顺序 


铝 材 在 加 工 后 也 会 产生 毛刺 , 所 以 同 ABS 材 一 样 , 也 要 用 雏 去 毛刺 , 如 
图 1.38 所 示 。 特别 是 在 图 1.35 中 指定 的 2.5mm (大 于 2mm, 小 于 3mm) , 如 
果 成 品 超过 3mm 的 话 , 转动 时 就 可 能 不 顺 滑 , 所 以 成 品 的 高 度 要 用 雏 来 调 
整 。 


|| 2.5 (2mm 以 上 ，3mm 以 下 ) 


(a) 铝 零件 F (表面 ) (b) FFF (背面 ) 


图 1.36 铝 零 件 的 尺寸 
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(a) 按 照 图 纸 把 厚度 2.5mm 的 方 管 切割 到 28mm (b) 按 照 图 纸 从 28mm 处 纵向 切割 


图 1.37 零件 F 的 加 工 


图 1.38 用 雏 调 整 高 度 


零件 G 也 同样 , HLA AMA ee RL, 用 金属 锯 按 55mm 的 长 度 
锯 成 4 根 。 
在 材料 G 上 划 4 个 孔 的 中 心 线 , 先 用 打 孔 机 打上 记号 , 再 用 销 头 打 孔 。4 
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个 孔 的 直径 均 为 8 3。 

切断 铝 材 的 窗 门 是 在 虎 钳 上 固定 结实 。 虎 钳 应 该 固定 在 像 桌子 那样 的 
台子 上 , 但 家 庭 用 的 桌子 有 时 没有 足够 的 空间 , 这 时 可 以 把 虎 钳 固 定 在 桌子 
下 方 的 腿 上 , 如 图 1.39 所 示 。 使 用 时 的 角度 虽然 比 通常 转动 了 90° , 但 可 以 
结 结实 实地 固定 住 , 便于 锯 断 铝 材 并 可 以 打 孔 。 


图 1.39 把 虎 钳 结实 地 固定 在 台子 上 


图 1.40 是 加 工 好 的 零件 F 和 零件 G。 让 我 们 看 一 看 零件 F 的 断面 , 它 是 
中 间 市 的 零件 , 但 和 原 动 节 相 组 合 的 部 分 是 止 形 的 , 也 就 是 刚才 用 铁 调 整 到 
小 于 3mm 的 地 方 。 

加 工 ABS 材 料 时 , 曾 多 做 了 一 个 材料 G。 在 这 里 , 把 那个 多 余 的 材料 G 用 前 
钳 切 成 两 半 , 像 图 1.41 那 样 把 一 半 的 材料 G 嵌 到 零件 F 的 止 处 。 如 果 加 工 准确 的 
话 , 只 要 把 材料 垦 进 去 就 可 以 固定 结实 ; 如 果 比 较 松 的 话 , 就 要 用 粘 接 剂 固定 。 
增加 这 个 材料 G 的 目的 是 为 了 使 零件 F 和 原 动 节 之 间 的 接触 比较 顺 滑 。 


全 


图 1.40 零件 F 和 零件 G 
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图 1.41 RASA H Ab 


另外 请 注意 , 要 使 材料 G 的 孔 和 零件 F 的 孔 一 致 , 如 果 错 位 的 话 轴 就 穿 
不 过 去 。 为 以 防 万 一 , MEG RASA, 要 用 $3 的 钻头 在 孔 中 慢 慢 地 
转动 着 通过 此 孔 , 如 图 1.42 所 示 。 在 注意 安全 的 情况 下 , 把 零件 F 固 定 在 虎 
FHES 


图 1.42 了 和 孔 错 位 时 的 修正 


3. 组 装 零件 

在 2 个 脚面 零件 G 之 间 放 和 零件 D 和 零件 E 后 , 穿 人 M3 螺 丝 。 请 注意 , F 
件 E 有 2 个 孔 的 一 侧 要 在 M3 螺丝 (M3x30) 的 另 一 端 , 如 图 1.43 所 示 。 

在 M3 螺丝 上 安装 螺母 。 螺母 不 可 拧 得 过 紧 , 以 后 在 可 动 部 位 安装 M3 螺 
母 时 也 同样 不 能 拧 得 过 紧 。 

在 零件 DD 的 那 一 端 , SEAM 3 R22 (M3 x 30) ,用 螺母 轻 轻 地 固定 住 , 如 
图 1.44 所 示 。 

在 零件 E 的 那 一 侧 , 放 入 零件 C, 和 零件 A 同时 穿 人 M3 螺丝 , 再 用 螺母 
轻 轻 固定 住 , 如 图 1.45 所 示 。 
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图 1.43 组 装 零件 E 和 D 


用 螺母 轻 轻 固 定 


a 


图 1.45 放 入 零件 C 


在 零件 E 的 那 一 侧 , 用 2 根 M3 螺 丝 (M3x30) 固定 零件 F, 在 里 侧 用 螺母 
国定 结实 后 便 完 成 了 一 只 脚 的 组 装 , 如 图 1.46 所 示 。 注意 : 螺母 只 在 此 处 固定 
结实 , 在 其 他 可 动 部 位 只 轻 轻 旋 上 即 可 ;, 不 然 的 话 , 可 动 部 位 便 不 能 动作 。 

按 同 样 的 方法 组 装 另 一 只 脚 。 

4. 加 工 齿轮 箱 

组 装 完毕 后 的 齿轮 箱 有 3 根 螺 丝 , HPQ BOR, 用 %3 的 钻头 
把 2 个 螺 孔 加 工 成 贯通 孔 , 如 图 1.47、 图 1.48 所 示 。 
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图 1.46 用 M3 螺丝 固定 零件 F 


这 根 螺丝 留 下 


把 这 2 个 孔 
做 成 贯通 孔 
1.47 用 钻 通 孔 
热 片 放 到 此 处 


| 切削 垫上 


图 1.48 WEAF, 放 到 齿轮 箱 上 


调节 曲柄 齿轮 箱 附 带 的 轴 的 长 度 , 如 图 1.49 所 示 。 在 装着 曲柄 杆 的 情况 
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下 , 轴 的 长 度 要 调节 为 93mm, 所 以 轴 本 身 的 长 度 应 为 87mm。 按 长 度 用 名 
锯 断 轴 , 锯 断 时 要 用 虎 钳 固定 结实 , 最 后 用 刍 把 毛刺 去 除 干净 。 

曲柄 杆 的 另 一 侧 (有 2 孔 的 一 侧 ) , 对 原 动 节 来 说 是 多 余 的 , 所 以 要 用 前 
HHA, 如 图 1.50、 图 1.51 所 示 。' 


这 个 长 度 为 93mm 


图 1.49 调节 轴 的 长 度 


9mm = $ 10mm 


图 1.50 ”前 去 曲柄 杆 的 厚度 


图 1.51 把 曲柄 杆 剪 断 


把 $3 的 黄 铜 贺 杆 固 定 在 虎 钳 上 , 用 钢 锯 截 下 130mm 的 长 度 后 再 用 刍 去 
毛刺 。 这 是 机 器 人 后 腿 用 的 轴 。 

把 齿轮 箱 的 盖子 , 2 根 支撑 柱 、6 个 垫 片 、 4 根 M3 螺 丝 (M3x30) 、4 个 
M3 螺母 、 黄 铜 贺 杆 、 加 工 后 的 曲柄 杆 及 加 工 后 的 齿轮 箱 进 行 组装 。 
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把 齿轮 箱 的 盖子 按 图 1.52 那 样 放 在 齿轮 箱 的 左右 两 侧 后 , 用 2 根 M3 螺 
丝 和 螺母 固定 住 。 

把 支撑 柱 和 3 个 垫 片 夹 在 齿轮 箱 盖 子 之 间 , 用 螺丝 和 螺母 固定 。 再 把 
130mm 长 的 黄 铜 圆 杆 插入 齿轮 箱 盖 子 的 孔 里 。 如 图 1.53 所 示 。 

制作 脚底 板 , 先 按 图 1.54 的 尺寸 在 ABS 板 上 划 出 2 块 板 的 线 。 

如 图 1.55 所 示 , 把 组 装 后 的 两 只 脚 放 到 划 线 的 ABS 板 上 , 再 用 记号 笔画 
出 出 零件 G 中 孔 的 位 置 。 按照 记号 笔 的 划 线 , 在 每 块 足 底板 上 分 别 打 4 个 %3 
的 孔 。 


(a) 穿 人 M3 螺丝 (b) 用 螺母 固定 
图 1.52 在 齿轮 箱 的 盖子 上 安装 零件 


(a) FH SR 2% Fs SCHR (b) 插 入 黄 铜 贺 杠 
图 1.53 插入 黄 铜 圆 杆 
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图 1.54 脚底 板 的 尺寸 
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ae 


41.55 ”确定 脚底 板 的 位 置 


像 图 1.56 那 样 , 把 齿轮 箱 的 轴 穿 过 1 只 脚 , 电机 的 轴 在 前 方 , I 
(eB, 零件 D 的 那 面 也 要 在 前 方 。 按 同样 方法 , 让 齿轮 箱 的 轴 也 穿 过 另 一 只 
Bi. 


(a) 把 一 只 脚 插 入 齿轮 箱 的 轴 上 (b) 把 两 只 脚 插 入 齿轮 箱 的 轴 
图 1.56 组 装 脚 和 齿轮 箱 


如 图 1.57 所 示 , 把 曲柄 杆 放 到 电机 上 , 用 M3 螺丝 (M3x12) 从 曲柄 杆 外 
侧 的 孔 穿 人 零件 F 后 用 双 螺 母 固 定 , 螺母 之 间 要 拧紧 。 这 样 可 以 防止 螺母 松 
弛 ,但 螺母 和 零件 F 之 间 要 留 一 点 点 的 空隙 , 要 使 曲柄 杆 和 零件 F 都 可 以 相 
互 活动 。 

如 图 1.58 所 示 , 两 脚 都 用 M3 螺丝 (M3x12) 穿 过 曲柄 杆 和 零件 F 后 , 再 
用 2 个 螺母 固定 。 

图 1.58 中 左右 曲柄 杆 的 安装 方向 是 相反 的 。 图 1.59 为 曲柄 杆 的 安装 示 
意图 。 请 确认 一 下 自己 安装 的 曲柄 杆 是 否 左 右 方向 相反 。 

用 M3 螺丝 (M3x12) 、 螺母 把 脚底 板 固定 在 脚面 零件 G 上 , 如 图 1.60 所 示 。 

按 图 1.61 安 装 电池 箱 , 完成 后 的 脚 如 图 1.62 所 示 。 
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图 1.57 用 M3 螺丝 和 2 个 螺母 把 曲柄 杆 固 定 到 零件 F 上 


图 1.58 两 脚 上 的 曲柄 杆 和 零件 F 的 M3 螺丝 、 螺母 的 安装 方法 


曲柄 杆 反 向 安装 


图 1.59 确认 曲柄 杆 的 位 置 
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a 


固定 脚面 和 脚底 板 


图 1.60 


图 1.61 安装 电池 箱 


(a) 从 侧面 看 (b) 从 前 
图 1.62 完成 图 


和 电池 箱 的 中 连接 


和 电池 箱 的 9) 连接 


把 电池 箱 和 齿轮 箱 用 双 面 胶带 固定 后 ， 
便 完 成 了 第 1 章 的 双 足 步行 机 器 人 


面 看 
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如 果 各 零件 制作 正确 , 脚 就 能 很 好 地 组 装 出 来 。 反之 , 就 只 有 修改 零件 
Ss 像 图 1.12 的 那 种 失败 , 就 要 把 材料 从 截断 开始 重新 制作 了 。 有 时 失败 的 
原因 是 因为 不 习惯 , 但 经 过 几 次 失败 后 就 会 正确 地 加 工 出 来 的 。 可 以 想象 出 
来 , 这 个 世界 上 那些 多 优秀 的 产品 , 正 是 很 多 的 技术 人 员 在 开发 阶段 经 过 无 
数 次 失败 后 才 成 功 的 。 

到 此 , 完成 了 脚 的 基本 制作 。 这 个 脚 要 一 直 使 用 到 第 5 章 。 此 后 每 章 都 会 
让 双 足 步行 机 器 人 逐渐 成 长 , 并 同时 伴 有 实验 。 

为 了 能 使 完成 后 的 机 器 人 顺利 动作 , 最 后 要 确认 一 个 要 点 : 在 脚 的 可 动 
部 , M3 螺 丝 上 的 螺母 不 是 太 紧 的 , 为 了 能 够 活动 , 应 该 留 有 少许 的 间隙 。 但 
随 着 多 次 的 步行 实验 , 螺母 有 可 能 会 移动 , 间隙 可 能 会 消失 。 所 以 应 注意 这 
一 点 , 不 要 把 可 动 部 位 拧紧 了 。 


1.4 脚 擦 地 步行 实验 


把 2 节 3 号 电池 放 人 电池 箱 后 打开 开关 看 看 : He, 脚 边 擦 着 地 边 努 力 地 
向 前 迈步 呢 ! 如 图 1.63 所 示 。 


图 1.63 第 1 章 的 双 足 步行 机 器 人 步行 的 样子 


将 图 1.63 与 1.1 节 中 人 的 步行 分 析 结 果 比 较 一 下 : 
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这 2 点 还 不 能 通过 呢 。 也许 因 为 这 个 原因 吧 , 步行 时 虽然 左 、 右 脚 交替 向 前 迈 
步 的 , 但 不 是 直线 行走 , 而 身体 边 左 右 转 动 , 脚 擦 地 向 前 步行 。 


fe LNI 
i) 


下 章 中 , 将 要 使 机 器 人 成 长 为 当 脚 向 前 迈步 时 , 能 把 迈 出 的 那 只 脚 拾 起 
来 , 用 另 一 只 脚 支 撑 身 体 且 能 直线 向 前 行走 的 双 足 步行 机 器 人 。 


出 


pray i= 
‘ig 


OAO 


直线 前 进 


一 一 1 个 电机 + 杠杆 一 一 


在 第 1 章 中 ， 我 们 制作 了 使 用 一 个 电机 的 双 足 步行 机 器 人 ， 但 
此 机 器 人 是 双 足 擦 着 地 步行 的 ， 没 有 达到 图 1.1 中 人 步行 动作 的 分 析 
结果 。 还 有 ， 前 进 时 不 能 直线 行走 ， 很 不 稳定 。 

在 第 2 章 中 ， 将 使 机 器 人 成 长 为 向 前 迈 脚 ， 不 是 擦 地 的 ， 而 是 
向上 抬 起 的 ， 更 接近 于 双 足 步行 的 机 器 人 。 为 此 ， 需 重心 移动 。 第 2 
章 将 设法 使 重心 移动 简单 化 。 另 外 ， 机 器 人 将 继续 使 用 第 1 章 中 制作 
脚 。 
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2.1 从 脚 擦 地 步行 中 脱离 

第 2 章 的 目标 是 使 机 器 人 成 长 为 当 脚 向 前 迈步 时 , 能 够 使 这 只 脚 问 上 拾 
起 后 再 向 前 步行 .让 我 们 再 看 一 看 在 第 1 章 中 制作 的 机 器 人 的 步行 动作 。 

比较 一 下 图 1.4 中 联 杆 结构 的 动作 @@ 一 @@. 可 以 看 出 , 动作 @@ 的 脚 是 向 上 . 
抬 起 的 , 但 在 第 1 章 制 作 的 机 器 人 进行 的 动作 @ 时 , 脚 却 是 拖 着 地 的 , 为 什么 
呢 ? 答案 是 重力 的 作用 。 

由 于 联 杆 结构 的 作用 , 应 该 抬 起 的 脚 却 因 重 力 的 作用 被 吸引 到 地 面 上 
T, 如 图 2.1 所 示 。 重 力 问 题 一 直 是 双 足 步行 机 器 人 的 难题 之 一 。 从 这 点 上 
看 , 能 灵活 地 对 付 重 力 , 用 双 脚 自由 阔步 行走 的 人 类 是 多 么 了 不 起 呀 。 


被 重力 拉 下 


图 2.1 左 脚下 降 


为 了 排除 重力 的 影响 , 用 手 把 机 器 人 向 上 提起 , 把 脚 动 一 动 时 , 在 右 脚 
着 地 的 状态 下 , 左 脚 确 确实 实地 抬 起 来 了 , 如 图 2.2 所 示 ; 松 开 手 时 , 机 器 人 
受 重力 的 影响 又 会 两 脚 擦 地 行走 , 成 了 第 1 章 中 的 双 足 步行 机 器 人 , 如 图 2 .3 
所 示 。 在 第 2 章 中 , 机 器 人 如 果 能 做 出 把 脚 抬 起 的 动作 的 话 , 不 就 可 抬 起 脚 
向 前 迈步 了 吗 ? 
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左 脚 为 图 1.4 
动作 QD 的 样子 


右 脚 为 图 1.4 
动作 @ 的 样子 


o 左 脚 向 上 


右 脚 着 地 


eee 


图 2.2 用 手 把 机 器 人 抬 起 的 样子 


eg 


左 脚 、 右 脚 都 着 地 


图 2.3 通常 的 步行 样子 


2.2 用 简单 的 方法 移动 重心 


让 我 们 考虑 一 下 如 何 能 让 在 第 1 章 中 制作 的 机 器 人 边 抬 脚 边 向 前 迈步 。 
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在 这 里 还 是 让 我 们 参考 一 下 双 足 步行 的 老 前 辈 一 一 人 的 动作 吧 。 实际 上 , 把 
单 只 脚 抬 起 步行 的 状态 只 是 连续 步行 动作 中 的 一 部 分 , 是 整个 身体 把 重力 
和 惯性 巧妙 地 控制 住 的 。 要 实现 这 种 状态 , 需要 很 多 的 电机 和 复杂 的 控制 
结构 。 本 书 的 目的 是 以 少量 的 电机 制作 双 是 步行 机 器 人 , 所 以 把 一 只 脚 抬 起 
可 以 作为 单独 的 动作 去 考虑 。 
做 一 下 把 右 脚 抬 起 后 的 静止 动作 。 一定 是 扬扬 曙 晃 着 达到 平衡 后 站 住 

的 。 静止 站 立时 不 要 使 用 手 取 得 平衡 , 这 个 姿势 可 用 静止 画面 表示 。 

”图 2.4 的 上 提 式 是 把 上 身 往 左 脚 上 移动 的 同时 , 抬 起 的 右 脚 稍微 靠 向 内 
侧 后 取得 平衡 的 , 图 2.5 的 上 提 式 是 把 上 身 往 左 侧 倾斜 后 取得 平衡 的 。 


图 2.4 FHERR 图 2.5 单 脚 上 提 式 2 


可 以 看 出 ; 两 种 式样 都 是 通过 把 重心 往 左 脚 上 移动 而 取得 身体 平衡 

的 。 

那么 , 也 让 本 书 的 机 器 人 抬 起 一 只 脚 时 , 把 重心 移 到 另 一 只 脚 上 。 关 于 

重心 移动 的 方法 , 图 2.4 中 的 足 脖 和 腰 处 需要 活动 , 需要 很 多 的 电机 ; 而 图 
2.5 中 , 只 需要 使 身体 倾斜 , 用 很 少 的 电机 就 可 以 实现 重心 移动 。 


使 身体 倾斜 的 方法 有 很 多 , 这 里 考虑 以 增加 最 少 的 零件 使 身体 倾斜 的 
方法 。 
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在 不 增加 电机 的 情况 下 , 增加 新 的 动作 如 何 ? 对 , 用 杠杆 。 只 在 两 脚 上 分 
别 增 加 一 根 杠 杆 就 可 实现 重心 移动 。 

如 图 2.6 所 示 , 在 抬 起 左 脚 的 同时 , 使 身体 向 右倾 斜 , 重心 移动 似乎 成 为 
可 能 。 : 


@) 在 左 脚 上 增加 杠杆 。 由 
于 脚 的 缩短 ， 此 杆 成 为 支撑 
杆 ， 使 足 底 向 外 弯曲 


@@ 在 右 脚 上 增加 杠杆 ， 
利用 脚 的 伸 长 拉 伸 足 底 。 


图 2.6 增加 杠杆 时 脚 的 动作 


用 图 2.6 中 增加 杠杆 的 方法 , 似乎 可 以 使 身体 倾斜 , 但 脚 的 结构 又 成 了 
问题 : 因为 身体 每 次 倾斜 时 , 脚 都 要 弯曲 。 所 以 , 要 想 办 法 进行 更 可 靠 的 重 
心 移动 。 

在 脚 上 安装 和 斜 台 *, 在 脚 不 弯曲 的 情况 下 , 身体 也 可 以 倾斜 。 如 图 2.7 所 
示 , 即使 脚底 板 不 弯曲 , 由 于 增加 的 杠杆 的 作用 , 在 与 抬 脚 方向 相反 的 方向 
E, 可 以 使 身体 倾斜 。 斜 台 和 增加 的 杠杆 可 以 用 ABS 材 料 制 作 。 和 斜 合 和 脚底 
AZ li) BY VA H BO BE TE BR 
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* 关 于 这 种 脚 的 结构 , 株式 会 社 cube 已 经 申请 了 专利 (专利 2002 一 299481, 20024104 
11 日 , 申请 种 类 为 普通 ) , 是 禁止 作为 商业 目的 使 用 的 。 


2.3 制作 增加 的 杠杆 


第 2 章 中 在 脚 上 增加 的 材料 见 表 2.1。 


表 2.1 第 2 章 中 在 脚 上 增加 的 材料 
mT T T 


BE 长 度 38mm 以 下 的 
风筝 线 | 30m/ 卷 
粘 接 剂 速效 粘 接 剂 


开始 制作 。 BUH Fe Se A), 按照 图 2.8 的 尺寸 和 图 2.9 的 配置 , 在 剩余 的 
ABS 板 上 划 线 。 此 时 的 制作 不 需要 像 第 1 章 制作 时 的 高 精度 , 可 以 忽略 塑料 切断 
刀 的 厚度 , 直接 在 划 线 上 切断 。 从 ABS 板 上 切 出 的 各 个 材料 如 图 2.10 所 示 。 


2.3 制作 增加 的 杠杆 43 we 


材料 M al Ë 材料 N 
lg 65 E 43 
材料 O 5 
+ 材料 P 
61 
65 
90 | 
3 $3 
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95 


图 2.8 材料 M、N、O、P、Q 的 尺寸 


材料 P 
n 
材料 P 
T] 
材料 P 
g| g 
KAE 
R| 
材料 P 


图 2.9 材料 M、N、O、P.Q 在 ABS 板 上 的 配置 
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在 材料 Q 上 打 孔 。 因 为 Q 材 料 较 大 , 可 以 先 把 材料 切断 后 再 打 孔 。 打 孔 
时 , 先 用 打 孔 机 在 打 孔 位 置 打出 记号 , 再 用 电钻 打 孔 , 操作 时 要 注意 安全 。 

把 材料 M 和 N 用 粘 接 剂 粘 接 到 材料 O 上 , 如 图 2.11 所 示 。 再 把 材料 P 放 到 
粘 接 后 的 M 和 N 上 , 用 ABS 粘 接 剂 粘 接 , 如 图 2.12 所 示 。 要 做 2 只 脚 的 。 


oo 中 


图 2.10 ”从 ABS 板 上 切 出 的 各 个 材料 


图 2.11 FRAP BHO. M, N 


FE Ha A Ri Be h EY OBL O EO Be Be HE, 如 图 2.13 所 示 。 粘 接 剂 要 用 使 
金属 和 ABS 都 能 粘 接 的 , 如 图 1.10 所 示 。 在 粘 接 前 , Bee A Be HE REE HE i 
动 。 
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图 2.12 把 材料 P 放 到 材料 M 和 N 上 粘 接 


图 2.13 Hi He Re He 


还 剩 有 2 块 材料 P, 现在 把 材料 P 安 装 在 脚面 上 。 按 图 2.14 所 示 在 材料 P 上 画 
出 脚面 上 和 孔 的 位 置 , 打出 4 个 %3 的 孔 。 打 孔 时 要 把 材料 固定 结实 , 注意 安全 。 


2.14 ”把 脚面 和 脚底 板 的 孔 对 准 
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图 2.15 是 装 有 匀 链 的 零件 和 打 了 4 个 $3 孔 的 脚底 板 , 共 2 套 。 


图 2.15 HE ATT FLAY A 


粘 接 图 2.16 中 的 2 个 零件 。 粘 接 完了 后 , 按 图 2.17 贴 上 双 面 胶 。 


图 2.16 用 塑料 夹子 固定 后 粘 接 


62.17 双 面 胶带 
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把 在 第 1 章 中 制作 的 脚底 板 拆 下 来 , 如 图 2.18 所 示 。 用 双 面 胶 把 上 述 零 
件 粘 接 到 脚底 板 上 , 再 在 脚底 板 上 增加 一 个 $3 的 孔 。 


增加 $3 的 孔 


用 双 面 胶带 粘 接 


图 2.18 ” 粘 接 到 脚底 板 上 


把 刚才 制作 的 零件 用 M3 螺丝 和 螺母 安装 到 脚面 上 , 如 图 2.19 所 示 ; 另 
一 只 脚 比较 难 安装 , 如 图 2.20 所 示 。 安装 时 , 不 要 旋转 螺丝 而 要 旋转 螺母 ， 
实在 安装 不 上 的 话 最 好 把 曲柄 杆 先 拆 纯 下 来 。 


ae 


图 2.19 安装 到 脚面 上 
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图 2.20 难 固 定 的 位 置 


按 图 2.21 所 示 安 装 杠 杆 。 到 此 , 第 2 章 的 双 是 步行 机 器 人 制作 完毕 。 


用 绳 绑扎 


图 2.21 安装 杠杆 后 完成 机 器 人 的 组 装 


2.4 直线 前 进 的 双 足 步行 实验 


快 做 实验 吧 。 把 制作 出 的 双 足 步行 机 器 人 放 在 水 平面 上 , 通 上 电源 看 看 。 
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如 图 2.22 所 示 , 是 身体 左右 倾斜 着 前 进 的 吗 ? 一 定 是 切切 实 实地 直线 前 


图 2.22 第 2 章 的 双 足 步行 机 器 人 步行 的 样子 


由 于 把 重心 移动 到 了 地 面 上 的 那 一 只 脚 上 , 是 把 脚 上 提 后 向 前 迈步 的 ， 
因此 第 1 章 中 出 现 的 问题 : 


ii 


得 到 了 解决 。 

第 1 章 中 的 双 足 步行 机 器 人 虽然 也 是 向 前 方 步行 的 , 却 不 是 直线 前 进 ， 
这 是 因为 向 前 迈 出 的 脚 没 有 抬 起 来 。 而 第 2 章 中 制作 的 双 足 步行 机 器 人 , 由 
于 把 向 前 迈 出 的 脚 抬 起 来 了 , 所 以 能 够 直线 前 进 。 另 外 , 从 “实验 : 理解: 重 
心 ” 中 可 以 知道 在 静止 状态 下 , 要 使 抬 起 一 只 脚 的 机 器 人 不 倒 下 去 , 必须 把 
身体 的 重心 落 到 另 一 只 脚 上 (其 正 下 方 应 该 有 支撑 ) 。 


由 于 脚 的 旁边 增加 了 杠杆 , 只 用 1 个 电机 就 实现 了 直线 前 进 的 双 足 步行 ， 
但 此 时 脚 的 外 观 却 不 太 雅 观 。 

在 下 述 的 第 3 章 中 , 将 把 杠杆 外 下 来 、 增 加 电机 , 用 与 第 2 章 不 同 的 方 
法 , 使 机 器 人 成 长 为 一 边 把 重心 移 到 一 只 脚 上 , 一 边 步 行 的 双 足 步行 机 器 
人 。 


q 50 ee 直线 前 进 
实验 ' 理解 


量 的 中 心 ， 但 | 


m i 


ip i 
20cm 左 右 的 线 ( 生 线 或 风筝 线 ) ， 
ERMINE ESHE, 


O 把 线 栓 入 纸板 人 形 的 一 ee 


板 人 形 下 垂 , 然后 mesem 
子 的 直线 位 置 。 ee 


O ERRAKI HAARE 


APSE, 再 用 记号 笔画 出 绳子 
HERNE, 


© ABR IF EHNA RIAL, 纸板 人 就 要 倒 下 。 


用 线 面 出 的 部 分 是 塑料 夹子 与 地 面相 接触 的 部 分 , 通常 
叫做 “支撑 区 ”。 把 上 述 实验 反复 进行 几 次 后 , 可 以 知道 : 


， 支撑 区 
@ 从 重心 垂直 向 下 的 箭头 在 塑料 来 子 的 a Als 而 @ 因 不 在 支撑 区 
A MASATE o 
A HOSULAE ULAR AWARE, 要 使 机 器 人 步行 时 不 倒 下 去 ， 必须 在 机 器 人 
重心 的 正 下 方 有 与 地 面相 接触 的 脚 (支撑 区 ) 。 此 种 步行 方式 称 为 静 步 行 。 当 机 
器 人 成 为 高 机 能 的 双 足 步行 机 器 人 时 ， 在 机 器 人 重心 的 正 下 方 即使 没有 着 地 的 脚 
(EK) , 步行 时 也 不 会 倒 下 , 请 参考 第 6 章 。 


人 S.. 


=O ERNIE, 
直线 后 退 


到 第 2 章 ， 机 器 人 已 经 成 长 为 能 直线 前 进 的 双 足 步行 机 器 人 
So 其 增加 了 杠杆 ， 却 旺 性 了 外 观 。 第 3 章 中 ， 将 把 杠杆 拆 下 来 ， 改 
用 其 他 方法 ， 使 其 成 为 边 移 动 重心 边 步行 的 机 器 人 。 那 时 ， 机 器 人 
不 光 能 前 进 ， 也 可 以 后 退 ， 还 可 以 用 遥控 器 进行 控制 。 

第 3 章 中 将 增加 一 个 电机 和 齿轮 箱 ， 组 成 重心 移动 的 结构 。 让 我 
们 亲自 制作 它 、 琐 控 它 ， 使 它 进行 直线 前 进 和 后 退 的 双 足 步行 机 器 
人 。 另 外， 和 第 2 章 一 样 ， 仍 使 用 第 1 章 中 制作 的 脚 。 
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到 第 2 章 为 止 , 都 是 把 装 在 机 器 人 身上 的 电源 开关 直接 打 到 ON OFF 
位 置 进行 行走 和 停止 的 。 第 3 章 中 , 将 对 机 器 人 的 动作 进行 控制 , 使 其 成 为 
能 遥控 前 进 、 后 退 和 停止 的 双 足 步行 机 器 人 。 

遥控 方法 有 无 线 方式 和 有 线 方式 , 无 线 方 式 中 有 无 线 电 控 制 和 红外 线 控 
制 等 。 本章 中 将 采用 操作 简单 的 有 线 方式 6P 扳 扭 开 关 进 行 适 控 。 

对 前 进 和 后 退 的 遥控 , 就 是 对 正 转 和 反 转 的 控制 。 在 本 书 中 制作 的 双 足 
步行 机 器 人 的 步行 用 原 动 节 的 转动 方向 , 也 就 是 电机 的 转动 方向 来 决定 肢 
的 动作 。 如 图 3.1 所 示 , 从 动作 @ 开 始 , 电机 是 正 转 的 , 动作 后 变 成 动作 @ 的 
样子 ; @ 是 电机 反 转 时 脚 的 动作 。 


@ 从 这 个 位 置 开始 回 产生 前 进 动作 的 原 动 节 的 转动 回 产 生 后 退 动作 的 原 动 节 的 转动 
图 3.1 电机 的 转动 ( 原 动 节 的 转动 ) 和 脚 的 动作 
如 图 3.2 所 示 , 当 调 换 电 池 的 “+” 极 和 “一 ” 极 时 , 电机 的 转动 方向 就 相 
反 。 
如 果 每 次 变换 前 进 和 后 退 都 要 调换 电池 的 “+” 极 和 “-” 极 , 是 很 麻烦 
的 。 利用 6P 扳 扭 开关 可 以 切换 “+” 和 “一 ” 极 , 如 图 3.3 所 示 。 
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图 3.2 ”电池 的 “+” 和 “-” 相 反 时 , 电机 的 转动 方向 就 相反 


(a) 停 止 


图 3.3 用 6P 开 关切 换 “+” 和 “一 ” 极 


如 果 步 行动 作 过 快 , 般 控 就 很 困难 , 所 以 要 把 步行 速度 降低 到 与 人 的 步 
行 相 接近 。 

在 第 1 章 和 第 2 章 中 使 用 的 曲柄 齿轮 箱 的 减速 比 为 441: 1, 在 可 供 选 择 的 
4 种 减速 比 中 是 比较 小 的 , 所 以 转动 速度 较 快 。 

在 脚 的 动作 上 , 可 以 按照 以 前 的 减速 比 。 但 对 于 3.1.3 节 中 将 要 增加 的 
齿轮 箱 来 说 , 如 果 不 增 大 减速 比 、 降 低速 度 的 话 , 其 动作 就 快 于 人 的 速度 。 

因此 , 组 装 齿轮 箱 时 , 要 用 最 大 的 减速 比 5402 :1 进行 组 装 , 如 图 3.4 所 示 。 


减速 比 ”第 2 段 12 : 42 第 3 段 12 : 42 第 4 段 12 : 42 第 5 段 12 : 42 
第 1 段 1: 36 


La ani 20 736 1 
总 减速 比 35 x 47 x Gy * P * 42 = 112021 056 = 540225 


图 3.4 4 速 曲柄 齿轮 箱 的 减速 比 约 为 5402 :1 
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像 在 第 2 章 中 实验 的 那样 , 要 使 双 足 步行 机 器 人 直线 向 前 步行 , BAIA 
起 一 只 脚 向 前 迈步 ; 后 退 时 , 也 必须 抬 起 一 只 脚 向 后 迈步 , 两 种 情况 都 需要 
抬 脚 这 个 动作 。 在 本 书 中 制作 的 双 足 步行 机 器 人 的 步行 方式 为 静 步 行 , 由 
第 2 章 “ 实 验 理解: 重心” 可知, 要 使 机 器 人 步行 时 不 倒 下 来 , 抬 起 一 只 
时 必须 把 身体 重心 移 到 另 一 只 脚 上 , 并 且 重 心 的 正 下 方 要 有 落地 的 脚 (支撑 
KR). 

那么 , 我 们 就 规定 把 重心 移 到 一 只 脚 上 吧 。 

在 2 只 脚 上 都 安装 重心 移动 的 结构 , 电机 至 少 需要 2 个 , 腰部 只 需要 1 个 
电机 。 这 样 , 重心 移动 的 方法 可 以 有 3 种 , 如 图 3.5~3.7 所 示 。 


图 3.6 重心 移动 方式 2 图 3.7 重心 移动 方式 3 
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图 3.5 的 重心 移动 方式 是 在 左右 移动 的 台子 上 放 上 电池 箱 , 重心 在 有 电 
池 箱 那 侧 的 脚 上 。 重心 在 右 脚 上 , 故 左 脚 可 以 悬空 。 

图 3.6 的 重心 移动 的 方式 是 在 旋转 的 台子 上 放 上 电池 箱 , 利用 台子 的 旋 
转 使 重心 移动 到 有 电池 箱 侧 的 脚 上 。 重心 在 右 脚 上 , 故 左 脚 可 以 悬空 。 

图 3.7 的 重心 移 到 的 方式 是 在 左右 倾斜 的 台子 上 放 上 电池 箱 , 重心 在 倾 
和 斜 侧 的 脚 上 。 重心 在 右 脚 上 , 故 左 脚 可 以 悬空 。 

在 本 章 中 制作 的 双 足 步行 机 器 人 ，, 力求 制作 简单 、 外 形 美 观 , 因此 采用 
图 3.7 的 结构 。 实际 上 , 要 把 重心 移 到 一 只 脚 上 , 仅仅 用 2 节 3 号 电池 的 重量 是 
不 够 的 , 要 让 电池 、6P 以 及 齿轮 箱 一 起 作为 重心 移动 结构 使 之 倾斜 。 

结构 定 下 来 了 , 接 下 来 考虑 前 进 和 后 退 的 方式 。 前 进 时 , 当 抬 起 右 脚 向 前 迈 
步 时 , 要 使 身体 向 左倾 斜 使 重心 加 在 左 脚 上 , 以 取得 平衡 , 如 图 3.8 所 示 ; 同样 ， 
当 抬 起 左 脚 向 前 迈步 时 , 要 使 身体 向 右倾 斜 , 把 重心 加 在 右 脚 上 , 如 图 3.9 所 示 。 


图 3.8 抬 起 右 脚 前 进 〈 重 心 在 左 脚 ) 图 3.9 抬 起 左 脚 前 进 〈 重 心 在 右 脚 ) 


后 退 时 也 一 样 , 当 抬 起 右 脚 向 后 迈步 时 , 要 使 身体 向 左倾 斜 , 把 重心 加 
在 左 脚 上 , 如 图 3.10 所 示 ; 抬 起 左 脚 向 后 迈步 时 , 要 使 身体 向 右倾 斜 , 把 重 
心 加 在 右 脚 上 , 如 图 3.11 所 示 。 

也 就 是 说 , 无 论 前 进 与 后 退 , 身体 倾斜 的 方向 是 和 抬 起 的 脚 相 反 的 。 当 
把 重心 加 到 着 地 的 脚 上 时 , 其 双 足 步行 就 应 该 是 直线 。 


图 3.10 ” 抬 起 右 脚 后 退 (重心 在 左 脚 ) 图 3.11 抬 起 左 脚 后 退 (重心 在 右 脚 ) 
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3.2 制作 增加 的 曲柄 齿轮 箱 


在 第 3 章 制 作 时 需要 的 材料 见 表 3.1。 
表 3.1 在 第 3 章 制 作 时 需要 的 材料 


HS100 x206, 厚 1.0mm 


1 东 急 HANds 

ABS 板 | 330x245, 厚 2.0mm i= 东 急 HANds 548 
胶木 | 3.1%22 项 区 铃 商 10 
AeA 4 速 曲 柄 齿轮 箱 | 模型 店 570 
开关 6P 扳 扭 开 关 2 秋月 电子 通商 100 
M3 螺丝 。 螺 母 M3x6 螺 丝 , M3 螺母 8 商店 5 

电池 006P 1 商店 150 
电池 箱 3 号 电池 x2 节 1 | 秋月 电 了 通商 | 6o 
电池 揪 钮 接头 电池 箱 用 1 秋月 电子 通商 10 


先 把 减速 比 为 5402 :1 的 齿轮 箱 准 备 好 , 如 图 3.12 所 示 。 


nip 加 工 的 目的 是 让 曲柄 齿轮 箱 能 安装 在 倾斜 
用 箱 上 。 


P 属 锯 截 断 ， ee 


(8 组 装 完了 的 曲柄 齿轮 箱 (b) 把 曲柄 杆 的 轴 按 46mm 的 长 度 截 断 


图 3.12 准备 减速 比 为 5402 :1 的 曲柄 齿轮 箱 


1. 制 作 倾 斜 用 箱 

要 制作 重心 移动 结构 , 需要 用 铝板 制作 倾斜 用 箱 。 虽 说 是 金属 加 工 , 但 
只 是 很 薄 的 铝板 , 与 第 1 章 中 的 铝 管 一 样 , 并 不 难 加 工 。 

图 3.13 中 , 倾斜 结构 由 电机 和 电池 箱 的 倾斜 用 箱 组 成 , 仍 使 用 在 第 1 章 
中 制作 的 脚 ,。 新 制作 的 铝 零 件 尺寸 如 图 3.14 所 示 。 
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电池 固定 在 电机 上 


倾斜 用 齿轮 箱 安装 在 倾斜 用 箱 1 


倾斜 用 箱 固定 在 脚 齿轮 箱 上 
图 3.13 电机 和 电池 箱 的 倾斜 结构 


150 


k 130 


3.14 铝 零 件 的 加 工 尺寸 


先 在 铝板 上 按 图 3.14 划 线 , 再 用 钢 锯 按 外 形 尺寸 句 断 。 操作 时 , 要 在 虎 
钳 上 固定 结实 。 

如 图 3.15 所 示 , 先 用 钢 锯 从 一 侧 开始 锯 , 大 约 锯 到 中 间 位 置 时 , 再 掉 转 
方向 从 男 一 侧 开始 锯 。 


图 3.15 铝板 的 锯 断 
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截断 后 , 在 划 有 打 孔 位 置 的 地 方 用 打 孔 机 打上 记号 , 如 图 3.16 所 示 。 用 
电 销 打 孔 , 钻头 的 尺寸 为 %3。 打 孔 时 , 应 将 铝板 放 在 稳定 的 台子 上 , 用 虎 钳 
固定 或 用 手 按 结实 , 一 定 要 注意 安全 。 


图 3.16 用 打 孔 机 打上 记号 


图 3.17 中 使 用 的 台子 是 计算 机 的 硬盘 外 壳 , 也 可 以 放 到 木板 上 打 孔 , 但 
木板 也 将 被 打上 和 孔 , 所 以 在 室内 作业 时 要 注意 。 


图 3.17 在 铝板 上 打 孔 (要 注意 安全 ) 


把 锯 断 的 铝板 折 弯 。 折 弯 线 应 在 虎 钳 的 夹 口 处 。 

图 3.18 所 示 的 虎 钳 , PSE BEE A, 不 能 使 折 弯 线 和 虎 钳 的 夹 口 一 致 ， 
所 以 要 用 金属 尺 和 什锦 铁 夹 住 后 固定 在 虎 钳 上 。 如果 固 定 得 很 结实 的 话 , 可 
以 用 手 弯曲 到 图 示 位 置 。 

因 弯 曲 部 带 有 圆 度 , 所 以 要 用 锤子 敲打 圆 处 使 它 成 为 直角 , 如 图 3.19 所 
示 。 此 时 也 是 用 金属 尺 和 什锦 铁 夹 住 后 固定 的 。 

图 3.20 是 完成 后 的 倾斜 用 箱 , 以 下 将 在 此 箱 上 安装 脚 用 齿轮 箱 和 重心 
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移动 用 齿轮 箱 。 


图 3.18” 折 弯 馈 材 图 3.19 最 后 用 锤子 加 工 


图 3.20 完成 后 的 倾斜 用 箱 


2. 安 装 脚 用 齿轮 箱 和 重心 移动 齿轮 箱 

在 完成 后 的 倾斜 用 箱 上 安装 重心 移动 用 的 齿轮 箱 , 如 图 3.21 所 示 。 用 4 
根 M3 的 螺丝 (M3x6) 和 螺母 固定 。 

按照 图 3.21 的 安装 方向 , 在 齿轮 箱 上 安装 曲柄 杆 , 再 用 螺丝 固定 在 倾斜 
用 箱 上 。 

安装 螺丝 如 图 3.22 所 示 。 因为 螺母 的 位 置 在 倾斜 用 箱 和 齿轮 之 间 狭 害 
的 地 方 , 所 以 要 用 尖 嘴 钳 夹 住 螺母 后 再 用 螺丝 刀 拧 紧 螺 丝 。 

到 此 , 完成 了 一 只 脚 的 移动 重心 结构 , 如 图 3.23、 图 3.24 所 示 。 以 下 将 制 
作 安 装 电池 的 箱子 。 也 就 是 说 由 于 安装 了 这 个 电池 , 可 以 移动 重心 , 从 而 把 
一 只 脚 抬 起 来 。 
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图 3.21 此 轮 箱 的 安装 方向 


人 a 


用 2 根 M3 螺 丝 


图 3.23 安装 完了 


固 


定 里 侧 用 螺母 固定 


图 3.24 在 脚 的 齿轮 箱 上 安装 倾斜 用 箱 
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3. 制 作 电 池 箱 
如 果 没 有 这 个 电池 , 即使 让 倾斜 用 箱 倾 斜 , 抬 起 一 只 脚 时 身体 仍 向 抬 肢 
的 方向 倾斜 , 重心 并 没有 完全 移 到 一 只 脚 上 。 如 图 3.25 所 示 。 


重心 不 能 落 在 左 脚 上 ， 


重心 能 落 在 左 脚 上 ， 
抬 起 的 右 脚 着 地 了 。 右 脚 可 以 抬 起 来 。 
(a) 抬 起 右 脚 使 电机 向 左倾 斜 (b) 抬 起 右 脚 使 电机 和 电池 向 左倾 斜 


图 3.25 用 于 移动 重心 的 电池 


为 了 脚 的 移动 和 重心 的 移动 , 使 用 2 节 3 号 电池 。 即便 如 此 , 重量 还 是 不 
够 的 , 还 要 增加 006P 电 池 , 这 种 电池 在 第 5 章 中 装载 在 微机 里 , 作为 微机 电 
源 。 

为 了 安装 电池 , 要 制作 电池 安装 箱 。 请 准备 新 的 ABS 材 料 , 按 图 3.26 的 
尺寸 划 线 。 另 外, 材料 @ 和 @ 将 在 第 5 章 使 用 。 先 在 打 孔 位 置 用 打 孔 机 打上 
记号 , 再 用 电 销 打 孔 。 ARTHA, 材料 在 裁 断 前 要 固定 结实 并 要 注意 安 
全 。 裁 好 后 的 材料 用 ABS 粘 接 剂 粘 接 , 请 对 照 图 3.26 中 的 顺序 。 

粘 接 过 程 如 图 3.27~- 图 3.31 所 示 。 
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图 3.26 电池 安装 箱 的 尺寸 图 


用 塑料 切断 刀 沿 线 切 断 ， 此 处 可 忽略 
塑料 切断 刀 的 厚度 。 


图 3.27 切 好 的 材料 
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用 ABS 粘 接 剂 粘 接 图 3.26 的 材料 D 和 @。 
注意 ， 和 @ 要 粘 接 成 直角 。 


图 3.28 ARO AMA © fy HR 


图 3.29 粘 接 材料 @ 图 3.30” 粘 接 材料 @ 


a 


图 3.31 粘 接 材料 
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到 此 , 电池 安装 箱 的 制作 完毕 。 
4. 焊 接 电线 
如 图 3.32 一 图 3.34 所 示 , 准备 连接 用 电线 。 


wos] 


图 3.32 电池 揪 钮 接头 线 的 焊接 


电池 撤 钮 接头 ( 黑 ) 


Weebl ere pe 
6P HE 
Ha HARES (ZL) 
图 3.33 电源 线 的 焊接 
D 连 向 电机 的 电线 长 度 大 约 为 lm， 此 电 
线 的 长 度 决定 了 可 以 追 控 的 距离 。 
短 电线 的 长 度 大 约 为 25mm。 
i ~ 
图 3.34 准备 电线 


如 图 3.35 一 图 3.37 所 示 , 把 连 向 电机 的 线 焊 在 6P 开 关上 。 
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连 向 电机 


在 图 3.34 中 焊接 的 短线 


图 3.35 把 连 向 电机 的 电线 焊 在 开关 上 (1) 


{ 


项 斜 箱 电 机 侧 的 电线 脚 部 电机 侧 
的 电线 


脚 部 电机 侧 
的 电线 


倾斜 箱 电机 侧 
的 电线 


在 对 角 线 上 焊接 
在 图 3.4 中 焊接 的 短线 


图 3.36 ”把 连 向 电机 的 电线 焊 在 开关 上 (2) 


图 3.37 ”把 连 向 电机 的 电线 焊 在 开关 上 (3) 
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5. 制 作 遥 控 器 

把 在 商店 里 购买 的 食品 盒 按 图 3.38 进 行 加 工 。 食 品 盒 的 大 小 约 为 90mam 
x60mmx55mm, 也 可 不 拘 于 此 尺寸 ， 只 要 能 放下 6P 开 关 和 2 节 3 号 电池 的 
电池 箱 就 可 以 了 。 

在 食品 盒 的 侧面 打 风 6 的 孔 , 用 于 穿 过 连 向 电机 的 4 根 电线 。 打 孔 时 要 注 
意 安 全 。 在 孔 的 内 侧 , 电机 的 电线 要 像 图 3.39 那 样 打 结 , 以 免 脱 落 。 


30 


sS g 


Q 


图 3.38 加 工 用 于 通 控 器 的 食品 盒 


将 6P 开 关 安 装 在 加 工 后 的 食品 盒 的 孔 上 , 如 图 3.40 所 示 。 
电池 揪 钮 接头 线 的 焊接 部 分 是 裸 线 , 要 用 绝缘 塑料 带 包 好 。 


用 塑料 带 绝缘 


图 3.39 食品 盒 里 的 电线 
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将 6P 开 关 穿 入 g 6 的 孔 后 固定 , 如 图 3.40 所 示 。 


> 6P 开 关上 的 凸 部 穿 过 
43 孔 后 ， 再 用 螺母 固定 。 


图 3.40 6P 开 关 的 固定 


把 电池 箱 装 进食 品 盒 中 , 如 图 3.41 所 示 。 


图 3.41 把 电池 箱 装 进食 品 盒 


盖 上 食品 盒 的 盖子 后 , 便 完成 了 遥控 器 的 组 装 , 如 图 3.42 所 示 。 


图 3.42 完成 后 的 遥控 器 
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6. 总 装 及 改进 

把 从 遥控 器 出 来 的 4 根 电 机 电线 焊 在 电机 上 , 从 脚 用 6P 开 关 出 来 的 电机 电线 
焊 在 脚 用 电机 上 , 从 重心 倾斜 用 6P 开 关 出 来 的 电机 电线 焊 在 重心 倾斜 用 电机 上 ， 
如 图 3.43 所 示 。 


重心 倾斜 用 电机 


脚 用 电机 


图 3.43 ”把 电线 焊 在 电机 上 


用 M3 螺 丝 和 螺母 把 电池 箱 固定 在 重心 倾斜 用 齿轮 箱 的 安装 孔 上 , 如 图 
3.44 所 示 。 用 双 面 胶 把 3 号 电池 盒 和 006P 电 池 固 定 在 电池 安装 箱 上 , 如 图 
3.45 所 示 。 


图 3.44 电池 安装 箱 的 固定 
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在 这 种 状态 下 , 合 上 开关 让 机 器 人 动 一 动 , 不 是 很 稳定 吧 ? 原因 在 于 脚 
底 , 脚底 上 露出 了 固定 机 器 人 脚面 用 的 螺丝 头 。 因此, 当 脚 着 地 时 , 并 不 是 整 
个 脚底 都 着 地 , 而 只 有 4 个 螺丝 头 着 地 。 要 进行 改进 ,和 从 前 一 样 , 用 塑料 切 
断 刀 切 下 两 块 50mmx65mm 的 ABS 材 料 。 

如 图 3.46、 图 3.47 所 示 , 把 脚底 材料 上 的 4 个 83 孔 扩大 到 $8。 FIILE, 
一 定 要 用 虎 钳 固 定 结实 , 用 手 按压 是 危险 的 。 因 为 打 的 孔 较 大 , 要 把 电钻 拿 
结实 ; 如 果 有 有 扩 孔 器 的 话 , 用 扩 孔 器 扩大 $3 的 孔 比 较 安 全 。 


图 3.45 粘 上 电池 


图 3.46 划 线 
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图 3.47 把 孔 扩 大 (用 扩 孔 器 较 安全 ) 


把 新 加 工 的 脚底 板 用 双 面 胶 贴 在 脚底 , 如 图 3.48 一 图 3.49 所 示 。 最 终 作 
品 如 图 3.50 所 示 。 


图 3.48 在 脚底 上 安装 增加 的 脚底 板 


图 3.49 ” 贴 到 原来 的 脚底 板 上 
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图 3.50 在 第 3 章 里 完成 的 双 足 步行 机 器 人 


A= i 


. BRE 行 实验 


3.3 直线 前 进 后 退 的 双 足 步 


让 我 们 实验 一 下 重心 能 否 移 动 。 

操作 倾斜 用 电机 上 的 控制 开关 : 开始 时 使 上 身 向 右倾 斜 (图 3.51) , 再 
使 身体 向 左倾 余 。 如果 左 右 方向 能 够 确认 的 话 , 在 遥控 器 的 开关 侧面 用 记 
号 笔 写 上 左 、 右 两 字 , 以 便 操作 。 

如 图 3.52 所 示 , 上 身 向 左倾 斜 着 . 想 一 想 ， ms 4 脚 会 向 前 迈步 ? BR EH Hs 
器 上 和 脚 的 电机 相连 接 的 开关 , 使 脚 的 电机 转动 , 此 时 左 脚 向 前 迈步 了 吧 ? 


图 3.51 使 上 身 向 右倾 余 
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图 3.52 使 上 身 向 左倾 斜 


图 3.53 的 情况 是 , 左 脚 在 前 , 身体 向 左倾 斜 着 。 操作 遥控 器 上 的 开关 ， 
让 右 脚 向 前 迈步 , 如 图 3.54 所 示 。 这 中 间 的 过 程 应 该 是 右 脚 边 抬 起 边 同 前 边 
步 , 再 落地 。 


图 3.53” 右 脚 在 向 前 移动 的 同时 抬 起 来 图 3.54 ” 右 脚 迈步 以 后 着 地 


当前 进 、 后 退 确 定 以 后 , 在 般 控 器 的 脚 电 机 用 开关 的 旁边 , 用 记号 笔 号 
上 “前 ”和 “后 ”, 以 便 操 作 。 

图 3.55 的 情况 是 , 右 脚 在 前 , 身体 向 右倾 斜 了 。 之 后 , 将 是 抬 左 脚 , 如 图 
3.56 所 示 。 所 谓 前 进 , 就 是 这 些 动作 的 反复 进行 。 
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图 3.55 左 脚 在 向 前 移动 的 同时 抬 起 图 3.56 左 脚 向 前 迈步 后 着 地 


RS i r ia 
al 


也 就 是 说 , 前 进 时 , 使 身体 向 往 前 伸 出 的 脚 的 那 一 方 倾斜 , 男 一 只 脚 向 
前 迈步 就 可 以 了 。 大 家 一 定 明白 机 器 人 双 足 步行 时 的 样子 了 吧 : 把 身体 的 重 
心 加 到 一 只 脚 上 , 另 一 只 脚 处 于 抬 起 状态 。 
”后退 时 , 让 脚 电机 的 旋转 方向 和 前 进 时 相反 。 看 看 图 3.57, 机 器 人 的 哪 
只 脚 在 后 ? 如 果 左 脚 在 后 , 就 要 转动 电机 使 右 脚 向 后 迈步 , 在 这 种 状态 下 使 
身体 向 右倾 斜 。 

左 脚 在 向 后 移动 的 同时 抬 起 , 向 后 移动 后 着 地 , 如 图 3.58、3.59 所 示 。 

向 后 步行 了 一 步 。 现在 的 情况 是 左 脚 在 后 , 那 就 使 身体 向 左倾 斜 。 然后 ， 
再 使 右 脚 向 后 移动 , 如 图 3.60、 图 3.61 所 示 。 后 退步 行 就 是 这 些 动作 的 反复 
进行 。 
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图 3.57 右 脚 在 后 、 向 右倾 斜 的 样子 


图 3.58 左 脚 在 向 后 移动 的 同时 抬 起 图 3.59 左 脚 向 后 迈步 后 着 地 
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i m 
图 3.60 右 脚 在 向 后 移动 的 同时 抬 起 图 3.61 右 脚 向 后 迈步 后 着 地 


到 此 , 实现 了 直线 前 进 、 后 退 的 双 足 步行 。 重心 倾斜 使 重心 移动 得 到 控 
制 , 所 以 可 以 用 改变 重心 倾斜 度 的 大 小 进行 各 种 实验 。 

试 着 改变 一 下 重心 的 倾斜 度 , 如 图 3.62 所 示 。 如 果 重 心 的 正 下 方 没 有 着 
地 脚 (支撑 区 ) ,身体 就 会 倾斜 , 行走 的 直线 性 就 会 变 差 。 


重心 的 正 下 方位 置 
图 3.62 重心 的 正 下 方 如 果 没 有 着 地 脚 , 抬 起 的 脚 便 不 能 悬 起 , 身体 倾斜 


由 此 得 出 : 要 使 双 足 步行 具有 很 好 的 直线 性 , 就 要 具有 图 3.63 所 示 的 那 
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在 第 4 章 中 , 将 利用 直线 性 较 差 的 步行 方式 , 使 机 器 人 成 长 为 会 转弯 的 
双 足 步行 机 器 人 。 


图 3.63 重心 的 正 下 方 如 果 有 着 地 脚 , 抬 起 的 脚 就 能 悬 起 来 行走 


实验 理解 


减速 比 和 转 条 的 实验 

双 足 步行 机 器 人 所 用 电机 的 一 个 重要 性 -<AA 

能 是 转 矩 。 所谓 转 矩 , 就 是 转动 时 所 需要 的 。 村/ 
eS 

oJ L 


”在 齿轮 箱 的 曲柄 杆 上 安装 辟 杆 


J, 如 果 转 和 矩 不 足 , 就 不 能 使 双 足 步行 机 器 Ao Meema 
动作 。 iM i Me : oS : z 


能 正确 地 求 出 转 矩 并 不 是 件 容易 的 事 。 | 
但 在 这 里 , 是 以 感受 到 转 矩 存 在 这 一 目的 ， 
Gene wee. a 

首先 是 用 于 重心 倾斜 的 齿轮 : 
杆 ” 吧 , 把 此 辟 杆 用 M3 的 螺丝 和 螺母 安装 在 = 
Ma o o 


在 齿轮 箱 上 , 安装 带 开关 的 3 号 电池 箱 。 | 
然后 , 在 家 庭 用 的 天 平 上 , 放 上 安装 在 齿轮 箱 
上 的 臂 杆 。 为 了 使 臂 杆 的 前 端 与 地 面 平行 , 在 | 
ACRE AO EIB. 另外 , 天 平 的 盘子 ce 
EEN, HOP RE ATA Pe. 


用 手 把 此 轮 箱 按压 结实 , 合 上 开关 。 读 出 
RRA BE 
转 矩 = 力 x 辟 长。 用 减速 比 为 441 :1 所 
齿轮 箱 测定 时 , 天 平 上 的 值 为 440g,， 所 
t= 440g x10cm=4400g- cm。 用 减 
比 为 126 :1 的 齿轮 箱 测 定时 , 天 平 上 的 值 为 
270g, Hee M-270gx10cm=2700g-em, 


减速 比 126:1 
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直线 前 进 、 
后 退 和 转弯 


一 下 人 化 机 一 一 


在 第 3 章 中 , 由 于 使 身体 倾斜 , 把 重心 移 到 了 单 丢 上 , 从 而 
RPO AOS HMPA, 向 后 迈步 的 脚 抬 起 后 退 。 在 第 4 
SD, 将 使 机 器 人 成 长 为 不 仪 能 直线 前 进 , 还 能 左右 转弯 的 双 
足 步 行 机 器 人。 当然 , AMA, 简单 这 一 宗旨 是 不 变 的 , 所 以 


要 在 不 追加 电机 的 情况 实现 上 述 目标 。 在 基本 构造 上 , 原封 不 
动 地 使 用 在 第 3 章 中 制作 的 双 足 步行 机 器 人 。 
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首先 , 让 我 们 再 次 让 在 第 3 章 中 制作 的 双 足 步行 机 器 人 动作 起 来 .让 它 
进行 各 种 动作 后 可 以 看 出 : 它 似乎 能 够 转弯 。 

从 左 脚 在 前 的 状态 开始 , 如 果 使 它 的 上 身 向 左倾 斜 、 右 脚 向 前 迈步 , 就 可 以 
直线 前 进 了 。 使 上 身 向 左倾 斜 是 为 了 把 重心 移 到 左 脚 上 , 保持 右 脚 悬 起 的 状态 。 

在 这 里 , 大 胆 地 做 一 做 与 此 种 状态 相反 的 : 在 上 身 不 倾斜 的 状态 下 , 使 
右 脚 向 前 迈步 , 将 会 怎样 呢 ? 

如 图 4.1 所 示 , 身体 向 右倾 斜 着 稍微 向 右 转弯 了 。 这 是 在 第 1 章 中 实验 的 


(a) 左 脚 在 前 ， 上 身 不 倾斜 


(e) 向 右 转弯 了 


图 4.1 上 身 不 倾斜 的 转弯 
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样子 ! 在 第 1 章 中 制作 的 双 足 步行 机 器 人 , 由 于 重心 没有 移动 , 一 步 向 左 一 步 
向 右 地 向 前 步行 。 由 于 目标 是 让 它 直 线 行走 , 因此 在 第 2 章 中 进行 了 改善 , 使 
重心 放 在 了 一 只 脚 上 , 可 以 让 脚 抬 起 。 但 是 从 转弯 的 角度 考虑 , 还 是 在 第 1 章 
中 体验 过 的 左右 转动 的 现象 可 以 利用 。 

也 就 是 说 , 在 上 身 不 倾斜 的 情况 下 , 使 脚 向 前 迈步 时 , 由 于 重心 没有 加 
到 一 只 脚 , 想 向 上 抬 起 的 脚 不 能 悬 起 , 在 重力 的 作用 下 又 着 地 了 , 使 身体 向 
那个 方向 倾斜 , 结果 身体 向 想 要 抬 脚 的 那 一 方 转弯 了 。 

在 第 3 章 中 的 双 是 步行 机 器 人 的 重心 是 可 以 控制 的 : 直 进 时 , 使 上 身 倾 
和 斜 , 把 一 只 脚 悬 起 ; 转弯 时 , 用 身体 不 倾斜 进行 控制 。 这 样 不 就 可 以 对 直线 
前 进 和 转弯 都 进行 控制 了 吗 ? 再 进一步 , 如 果 把 重心 移 到 要 抬 起 的 那 只 脚 上 
会 是 怎样 ? 做 做 看 。 

如 图 4.2 所 示 , 使 左 脚 处 于 向 前 迈 出 的 状态 。 直线 前 进 时 , 身体 是 向 左倾 


(a) 重心 向 右倾 斜 ”全 在 重心 向 右倾 斜 的 情况 下 向 前 迈 右 肢 


(c) MAR TKS 
图 4.2 在 重心 向 右倾 斜 的 状态 下 转弯 
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斜 的 。 此 时 相反 , 让 它 向 右倾 斜 , 并 且 使 右 脚 向 前 迈 出 。 转 了 一 个 比 刚才 还 要 
KS! 我 们 发 现 转弯 的 方法 了 。 仔细 观察 一 下 机 器 人 转弯 的 样子 , 要 是 改 
变 一 下 脚底 板 的 形状 的 话 , 将 会 转 更 大 的 弯 。 

我 们 着 重 看 一 下 机 器 人 脚底 板 接地 时 样子 。 图 4.3(a) 是 前 进 右 转弯 的 时 
修 , 由 于 身体 向 右倾 斜 , 所 以 转 了 弯 。 如果 把 脚底 板 的 右 后 部 切 掉 将 会 怎样 
呢 ? 机 器 人 不 就 会 倾斜 更 大 、 转弯 更 大 了 吗 ? 

同样 , 后 退 右 转弯 时 , 如 果 把 脚底 板 的 左 后 部 切 掉 , 也 会 倾斜 更 大 、 转 
SEK, 如 图 4.3(b) 所 示 。 

当然 , 切 掉 的 部 分 不 能 影响 直线 前 进 。 

那么 , 规定 切 掉 脚 底板 的 方法 吧 。 在 脚面 上 用 螺钉 固定 着 板子 , 脚底 板 
只 是 用 双 面 胶 贴 在 板子 上 的 , 很 容易 拆 下 来 。 按 自己 喜欢 的 形状 切割 , 用 各 
种 形状 进行 实验 是 很 令 人 愉快 的 。 

一 边 想象 着 将 要 出 现 的 意 想不到 的 结果 , 一 边 尝 斌 着 各 种 实验 。 如 果 没 
有 出 现 预 想 的 结果 , 就 要 分 析 一 下 原因 并 进行 改进 。 

笔者 是 决定 切 掉 脚底 板 的 后 半 部 。 但 也 不 要 局 限于 此 , 要 根据 自己 想 要 
的 转弯 角度 大 小 进行 调节 。 

在 第 5 章 的 微机 控制 中 , 如 果 把 脚底 板 的 后 半 部 切 掉 , 后 退 时 容易 倒 下 

(惯性 力 的 影响 ) ; 如 果 切 掉 的 部 分 较 小 , 则 不 受 影响 。 


(3) 前进 有 转弯 (b) 后 退 右 转 杰 


图 4.3 脚底 的 观察 
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4.2 脚 的 加 工 


把 用 双 面 胶 粘 上 的 左 、 右 脚 底板 拆 下 来 。 然 后 , Ze. 右 脚 分 别 按 图 4.4 的 
尺寸 进行 切割 , 虚线 部 分 是 切 去 的 部 分 。 切 宙 时 使 用 塑料 切断 思 。 


图 4.4 转弯 型 脚底 板 的 加 工 尺寸 


切 掉 以 后 , 用 双 面 胶带 粘 到 固定 在 脚面 的 板子 上 , 如 图 4.5 所 示 。 


| 
2 


图 4.5 用 双 面 胶带 安装 脚底 板 


4.3 转弯 实验 


现在 , 进行 转弯 的 双 足 步行 实验 吧 。 从 前 进 的 步行 开始 。 
如 图 4.6 所 示 , 左 脚 在 前 的 状态 下 , 使 重心 向 右倾 斜 , 右 脚 向 前 迈步 , 再 
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使 身体 大 幅度 倾斜 的 同时 , 向 右 转 弯 了 。 


(a) 左 脚 在 前 ， 重 心 向 右倾 斜 (b) 使 身体 向 右 大 幅度 倾斜 


Wires 2! 


(c) ETERS (d) 向 右 转弯 结束 


图 4.6 使 用 了 重心 倾斜 的 右 转 弯 (从 左 脚 在 前 开始 ) 
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如 图 4.7 所 示 , 右 脚 在 前 的 状态 下 , 把 重心 向 左倾 斜 , 左 脚 向 前 迈步 , 再 
使 身体 向 左倾 斜 的 同时 , 向 左 转弯 了 。 此 转弯 角度 并 不 像 右 转弯 的 那样 大 ， 
但 把 重心 的 倾斜 加 大 后 , 转弯 角度 也 会 变 大 。 


(a) 右 脚 在 前 ,重心 向 左倾 斜 (b) 使 身体 向 左 大 幅度 倾斜 


(e) 向 左 转弯 结束 


图 4.7 在 重心 向 左倾 斜 的 状态 下 左 转弯 (从 右 脚 在 前 开始 ) 
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接 下 来 是 后 退 。 如 图 4.8 所 示 , 左 脚 在 后 , 把 重心 向 右倾 斜 , 右 脚 向 后 移 
动 , 身体 向 右倾 斜 的 同时 向 右 转 弯 了 。 


(a) 左 脚 在 后 ， 重 心 向 右倾 斜 (b) 使 右 脚 向 后 移动 


Dies ies 
: 


(c) 向 右 转弯 结束 


图 4.8 使 用 了 重心 倾斜 的 右 转 弯 (从 左 脚 在 后 开始 ) 
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如 图 4.9 所 示 , 右 脚 在 后 , 使 重心 向 左倾 斜 , 左 脚 向 后 移动 , 再 使 身体 
向 左倾 斜 的 同时 , 向 左 转弯 了 。 


由 | 

ae 要 

eo i 

f i 

a n da mm 
(a) 右 脚 在 后 ， 重 心 向 左倾 斜 (b) 使 左 脚 向 后 移动 


a 


(6) 向 左 转弯 结束 
图 4.9 边 后 退 边 向 右 转弯 (从 右 脚 在 后 开始 ) 


无 论 前 进 还 是 后 退 , 都 可 以 进行 转弯 了 。 到 此 , 机 器 人 已 成 长 为 可 以 直 
线 前 进步 行 、 直 线 后 退步 行 、 前 进 左 转弯 、 前进 右 转弯 、 后 退 左 转弯 、 后退 
右 转 弯 的 双 足 步行 机 器 人 了 。 


S 用 微机 目 动 控制 


到 第 4 章 ， 双 足 步行 机 器 和 人 不仅 能 直线 前 进 和 后 退 ， 也 可 以 往 
左 、 右 方向 转弯 了 。 每 次 进行 前 进 、 后 退 和 转弯 的 切换 时 ， 都 是 由 
和 机 器 人 相连 接 的 开关 进行 的 。 

在 第 5 章 里 ， 终 于 搭载 微机 了 。 由 安装 的 传感器 ， 一 边 判断 着 现 
在 的 姿势 ， 一 边 双 足 步 行 ， 成 长 为 能 按 程序 自动 控制 的 双 足 步行 机 
器 人 。 
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5.1 微机 的 作用 


微机 就 是 小 型 电脑 。 提起 电脑 , 马上 联想 到 放 在 桌子 上 的 电脑 。 不 过 ， 
微机 的 使 用 范围 相当 广 , 在 很 多 看 不 到 的 地 方 也 被 大 量 使 用 着 , 比如 微波 炉 
里 . 电视 里 、 空调 机 里 、 汽车 里 .工厂 里 的 机 器 中 …… 等 等 。 

微机 能 做 什么 ? 根据 开关 和 传感器 的 输入 信号 , 执行 被 预先 编 入 的 程 
序 , 输出 使 电机 转动 、 鸣 笛 、 使 电灯 发 光 这 样 的 信号 。 我 们 把 这 种 微机 所 做 
的 工作 叫做 控制 。 

图 5.1 就 是 本 书 的 双 足 步行 机 器 人 的 微机 控制 。 


> 2 L 
有 信号 a TRS 
9 信号 从 微机 来 的 信号 KS 


l 
I semas 


[ 安装 在 电机 上 的 旋转 传感器 ] [微机 ] 
旋转 传感器 把 电机 的 转动 执行 程序 ， 根 据 传感器 的 信 care 
转变 成 信号 ， 送 给 微机 。 号 发 出 让 脚 或 重心 倾斜 用 电 [ 双 足 步行 机 器 人] 
机 动作 的 信号 。 | 根据 微机 的 信号 ， 脚 或 重心 倾 科 


用 电机 转动 ， 进 行 双 足 步行 


图 5.1 用 微机 控制 双 足 步行 机 器 人 


转动 传感器 ”一 -~ 微机 一 一 电机 末 级 前 置 放大 器 一 一 = 电机 
(输入 信号 = 小 电流 ) (输出 信号 = 小 电流 ) (大 电流 ) 


图 5.2 电机 和 微机 之 间 需 要 电机 末 级 前 置 放大 器 


由 微机 传 来 的 输出 信号 , 不 能 直接 转动 电机 。 这 不 光 是 电压 不 一 致 ， 从 
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微机 输出 的 电流 太 小 , 不 能 转动 电机 。 


因此 , 需要 电机 末 级 前 置 放 大 器 这 种 电路 , 将 从 微机 来 的 输出 信号 变 成 
大 的 电流 , 供给 电机 。 


为 了 知道 电机 的 转动 位 置 而 设置 的 传感器 称 为 旋转 传感器 。 
本 书 中 在 廉价 的 齿轮 箱 上 安装 旋转 传感器 , 如 图 5.3 所 示 , 其 原理 与 伺 


服 电机 相同 。 


一 旋转 传感器 
根据 旋转 传感器 转动 的 
角度 ， 可 以 知道 电机 旋 
转 的 角度 。 


图 5.3 自制 伺服 电机 的 结构 原理 


如 第 1 章 一 第 3 章 的 实验 一 样 , 为 了 使 双 足 步行 机 器 人 步行 时 向 前 迈 出 的 
Fal RE AOR, 关键 是 把 重心 移 到 一 只 脚 上 。 
例如 , 为 了 使 左 脚 悬 起 , 要 把 重心 向 右 侧 倾斜 , 其 控制 过 程 如 图 5.4 所 示 。 


TY 
按 适 当 的 角度 转动 重 @@ 向 电机 未 级 前 置 放大 器 去 的 信号 
心 倾斜 电机 。 


|| 使 脚 电机 转动 ， 让 左 脚 悬 起 。 


@ 从 重心 倾斜 转 动 传感器 来 的 信号 习作 ey 

微机 根据 从 旋转 传感器 来 的 hy z 

信和 号， 可 以 知道 重心 倾斜 的 

角度 。 微机 根据 从 旋转 传感器 
来 的 信号 ， 可 以 知道 左 
脚 的 位 置 


图 5.4 对 脚 电机 和 重心 倾斜 电机 的 控制 
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5.2 微机 的 搭载 


微机 种 类 很 多 , 性 能 各 异 , 虽然 很 多 登 在 商品 目录 (简介 ) 上 , 但 实际 上 
却 很 难 买 到 。 因 此 , 选 定 微机 时 最 重要 的 是 看 能 否 买 到 。 图 $.5、 图 5.6 所 示 
的 PIC 微机 和 互 8 微机 , 很 容易 在 秋 叶 原 电器 店 及 网 上 买 到 。 


[ H8 微 机 ] 
[PIC 微机 ] 四 品名 AKI-H8/3694F 
D 品名 PIC16F88-IP © 价格 1650 日 元 
D 价格 230 日 元 © 7O 端 口 数 29 ( 其 他 输入 8 ) 
@ oši OK 15 (其 他 输入 1 ) @ 其 他 AD 转换 器 ， 定 时 器 
@ 其 他 AD 转换 器 ， 定 时 器 ， 串 行 通信 


串 行 通信 © 写 人 程序 内 设 写 入 程序 
O SARF 需要 专用 的 写 人 程序 


图 5.5 PIC16F88 图 5.6 H8/3694F 


本 书 用 于 双 足 步行 机 器 控制 的 微机 选 定 为 H8 微 机 中 的 AK1-H8Z3694F， 
如 图 5.7 所 示 。 


在 这 些 针头 上 ， 连 接 
着 H8/3694F 微 机 的 信 
号 ， 从 传感器 来 的 信 
号 或 走向 电机 末端 前 
置 放大 器 的 信号 都 通 
过 此 针头 


此 处 为 H8/3694F 微 机 本 体 
(a) EMi (b) # m 


图 5.7 AKI-H8/3694F 微 机 的 外 形 


在 本 书 的 双 足 步行 机 器 人 中 , 不 光 要 对 机 器 人 的 单 体 进行 控制 , 当 电脑 
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和 双 足 步行 机 器 人 进行 电子 通信 的 同时 也 要 能 进行 控制 。H8 微 机 只 要 与 电 
RERE, 便 能 写 人 软件 , 非常 方便 。 

另外 , H8 微 机 的 IZO 端 口 数 较 多 , 以 后 增加 传感器 和 电机 也 很 方便 。 
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由 微机 传 来 的 信号 可 以 使 电机 转动 或 停止 , 但 此 信号 的 电流 较 小 , 不 能 
直接 使 电机 转动 , 所 以 必须 在 微机 和 电机 之 间 加 入 电机 末端 前 置 放 大 器 。 

电机 末端 前 置 放 大 器 根据 从 微机 来 的 信号 , 使 大 电流 流向 电机 , 从 而 能 
使 电机 正 转 、 反 转 或 停止 。 让 电机 正 转 及 反 转 时 , 还 必须 要 切换 电池 的 + 、 一 
极 。 每 次 都 切换 +. 一 极 是 很 麻烦 的 , 因此 考虑 使 用 电路 进行 +、- 极 的 切换 。 
具有 代表 性 的 是 称 为 “HH 电 桥 ” 的 电路 , 其 原理 可 以 用 图 5.8 的 开关 动作 来 理 


/ ® /@ 1@ [2 /@ [|@ 
| ae | 
电源 - 极 电源 - 极 电源 - 极 
电机 和 电源 及 开关 的 连 开关 中 和 开关 人 @@) 闭 合 时 ， FROMAROA EA 
接 如 同 H， 所 以 称 为 H 电流 按 电源 + 一 > 开关 QD 电流 按 电源 + 一 > 开关 (2) 
电 桥 一 ~ 电机 一 > 开关 @) 一 电机 一 开关 @ 一 
电源 -流动 ， 电 机 正 转 电源 -流动 ， 电 机 反 转 
(a) 电 机 和 4 个 开关 (b) 电 机 的 正 转 (e) 电 机 的 反 转 


图 5.8 五 电 桥 电 路 的 原理 


实际 的 互 电 桥 电路 是 没有 开关 的 , 而 是 使 用 了 和 开关 具有 相同 作用 的 
FET 半 导体 元 件 , 如 图 5.9 所 示 。 它 有 被 称 为 控制 极 、 漏 极 、 源 极 的 3 个 端子 ， 
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在 控制 极 上 加 上 电压 时 , 从 漏 极 可 以 向 源 极 流入 
大 的 电流 。 由 于 控制 极 的 电压 作用 , 漏 极 和 源 极 


”PP ”之 间 具 有 开关 的 作用 。 
rea 本 书 中 制作 的 电机 末端 前 置 放大 器 , 就 是 用 
"FET 代替 图 5.8 中 的 开关 。 使 用 了 ET 的 HH 电 桥 
电路 如 图 5.10 和 图 5.11 所 示 ， FETQ@ 一 四 代替 了 
图 5.9 FET 图 5.8 中 的 开关 @ 一 @。 


图 5.11 重心 倾斜 用 电机 末端 前 置 放大 器 电路 图 
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电机 正 转 时 , 从 微机 来 的 信号 把 FETO 和 FETG@ 闭 合 _ FET@ 和 FET@ 
断 开 , 电流 的 流向 为 3V 电 源 + 一 FETO 一 电机 一 FETG@ 一 电源 一 。 
电机 反 转 时 , 从 微机 来 的 信号 使 FETO 和 FET@ 闭 合 _FETO 和 FETGO 
断 开 , 电流 的 流向 为 3V 电 源 + 一 FETO@ 一 电机 一 FETQ@ 一 电源 一 。 
另外 , 从 微机 来 的 信号 只 有 “1” 和 “0”2 种 。 本 书 中 使 微机 动作 的 电压 
SV, 故 信号 为 “1” 时 , 电压 为 5V; 信号 为 “0” 时 , 电压 为 “0”V。 
FET 有 N 沟 道 型 和 P 沟 道 型 。 在 图 5.10 和 图 5.11 中 , FETOMFETOR 
P 沟 道 型 , FET@ 和 FET@ 为 N 沟 道 的 FET。 当 加 在 控制 极 上 的 信号 为 “0” 
(OV) 时 , P 沟 道 的 FET@ 和 FET@ 闭 合 (ON); 当 加 在 控制 极 上 的 信号 为 
“1” (5V) 时 , N 沟 道 的 FET@ 和 FET@ 闭 合 (ON). 
图 5.10 和 图 5.11 中 , 有 D- 这 样 的 记号 , 称 为 NAND 电 路 。NAND 电 路 
的 输入 信号 和 输出 信号 的 关系 如 图 5.12 所 示 。 


输出 信号 “1” MARS 输入 信号 “0” 


MUT 输出 信号 “1” 
输入 信号 “1” 输入 信号 “0” 输入 信号 “0” 


(a) (b) (c) 


图 5.12 NAND 电 路 的 输入 信号 和 输出 信号 的 关系 


@ 输 入 的 两 个 信号 都 为 “1”(5V) 时 , NAND 的 输出 信号 为 “0” 
(OV) . 
@ 一 个 输入 信号 为 “1”(5V) 、 另 一 输入 信号 为 “0”(0V) 时 , NAND 
的 输出 信号 为 “1”(5V)。 
@ 输 入 的 两 个 信号 都 为 “0”(0V) 时, NAND 的 输出 信号 为 “1” 
(SV 
也 就 是 说 , 只 有 当 两 个 输入 信号 都 为 “1”(5V) 时 , NAND 的 输出 信号 
才 为 “0”(0V) , 图 5.11 和 图 5.12 中 , NAND 电 路 的 1 个 输入 连接 着 5V。 H 
外 ,NAND 电 路 的 输出 和 FETO (P 沟 道 )、FET@ 的 控制 极 相连 简化 后 如 
图 5.13 所 示 。 要 使 FETQ@ (P 沟 道 ) 和 FETQ@ (Pi) AA (ON) 的话, 可 
在 控制 极 加 上 “0? 信号, 所 以 只 要 微机 输出 的 信号 为 “1” 就 可 以 了 ; FET® 
和 FET@ 为 N 沟 道 FET, 当 从 微机 来 的 信号 为 “1” 时 闭合 (ON) 。 在 图 5.10 
中 , 从 微机 来 的 信和 号 与 电机 正 , 反 转 的 关系 见 表 5.1。 
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5V( 信 和 号 “1”) 
和 FET(P 沟 道 ) 的 控制 极 相连 
从 微机 来 的 信号 


图 5.13 在 图 5.10 和 图 5.11 中 使 用 的 NAND 电 路 


表 5.1 从 微机 来 的 信号 IN0-0~IN0-3 和 电机 的 转动 


iE 转 1 
反 转 0 
制动器 0 
停 止 0 
禁止 1 1 
禁止 2 * 
禁止 3 1 
* 表 示 信 号 “1”、“0” 可 任 选 。 


0 
1 
0 
0 
* 
1 
1 


— 一 * or O r 
一 +r orf Ff O 
oo Ss * 一 一 © ks 
一 5 or O = 
一 + =- | 


0 
1 
1 
1 
0 
* 
0 


禁止 1 状态 下 , FET@ 和 FET@ 闭 合 (ON) , 电流 从 电源 + 极 流向 电源 一 
极 , 没有 通过 电机 , 即 处 于 短路 状态 , 这 是 非常 危险 的 。 

禁止 2 状态 下 , FET@ 和 FET@ 闭 合 (ON) , 和 禁止 1 一 样 , 电流 从 电源 
+ 极 流 向 - 极 , 也 没有 通过 电机 , 处 于 短路 状态 , 非常 危险 。 

禁止 3 也 相同 。 编写 程序 时 , 一 定 要 注意 禁止 使 用 禁止 1 一 禁止 3 状态 。 


jahis 
i 
i y 


5.1.3 对 伺服 电机 进行 了 说 明 , 其 使 用 的 检测 转动 的 传感器 就 是 将 要 设 

计 的 旋转 传感器 。 这 里 选用 ALPS 制 电阻 式 传感器 RDC803001A, 如 图 5.14 
(a) 所 示 。 

旋转 传感器 的 电路 如 图 5.14(b) 和 (c) 所 示 , 端子 @ 与 5SV 电 源 相 连 , 端子 
@ 与 GND 相 连 , 端子 @ 与 微机 的 传感器 信和 号 输入 端子 相连 。 

像 5.1.3 中 对 伺服 电机 的 说 明 那 样 , 旋转 传感器 通过 齿轮 与 电机 联动 
而 旋转 , 旋转 时 , 其 电阻 值 是 变化 的 , 与 此 相对 应 , 其 输出 的 电压 也 是 变化 
的 。 
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电阻 式 传感器 RDC803001A(ALPS) 


电阻 式 传感器 RDC803001A(ALPS) 


(a) RDC 803001A 端 子 号 (b) 脚 电机 的 旋转 传感器 


图 5.14 旋转 传感器 


(c) 重 心 倾斜 电机 的 旋转 传感器 


旋转 传感器 输出 电压 的 变化 原理 是 欧姆 定律 。 


5.4 旋转 传感器 扩展 线路 板 、 电 机 末 级 前 置 放大 
器 的 制作 


需 增 加 的 零件 见 表 5.2。 


表 5.2 增加 的 零件 


微机 AK1-H8/3694F 1 秋月 电子 通商 1650 
单 面 万 能 板 C 型 , 72mmx47mm 3 秋月 电子 通商 70 
电线 10 芯 ,15 列 0.12mm,3m 1 千石 电 商 70 
电阻 式 旋转 传感器 RDC803001A (ACPS) 2 | chip one stop 572 
IC 插头 14 针 1 秋月 电子 通商 50 
IC 74HC00 1 秋月 电子 通商 50 
FET 模 块 MP4212 2 maruthu 零 件 馆 | 598 
陶瓷 电容 器 0.1uF 4 秋月 电子 通商 100 
1/4W 电 阻 10kQ 8 千石 电 商 5 
1/4W 电 阻 3900 2 千石 电 商 5 
LED ( 兰 ) 2V,10mA 左 右 1 铃 商 10 
LED ( 红 ) 2V,10mA 左 右 all 铃 商 10 
针 型 插座 40P (20x2) 2 秋月 电子 通商 80 


ay 100 
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续 表 5.2 
针 型 插头 40P (20x2) 2 秋月 电子 通商 i 
it joe TA4805S 1 秋月 电子 通商 100 
器 5V/A) 
3.5mmY 体 小 插头 = = 
(还 电线) 1.8m 1 秋月 电子 通商 210 
FFX 线路 板 用 扳 扭 开关 , 3P 1 秋月 电子 通商 80 
拨 动 开关 2 电路 , 2 接点 1 | 铃 商 30 
立体 小 插 孔 83.5 (线路 板 用 ) 1 铃 商 100 
电池 扳 钮 纵 型 或 横 型 1 秋月 电子 通商 10 
焊锡 电子 零件 用 (80.6mm 左 右 ) 1 商店 1029 
热 收缩 套 管 SS 1 模型 店 158 
平 齿轮 42 齿 x3mm, 0.5 模 数 2 模型 店 Fi 231 
D 辅 助 连接 器 外 壳 9P 1 秋月 电子 通商 50 
D 辅 助 连接 器 OPE (焊接 类 型 ) 1 秋月 电子 通商 50 
M3 螺 丝 M3x30 2 商店 =a 5 
M3 螺 丝 M3x6 10 商店 5 
M3 螺丝 M3x12 5 
3 
长 100mm 以 上 1 100 
M4 螺母 M4 8 
支撑 柱 10mm 套 件 Ley ; 100 
垫 片 M3 4 商店 5 


电子 零件 怕 热 , 多 易 损 坏 , 所 以 制作 时 应 充分 注意 。 现 在 说 明 一 下 焊接 
的 窍门 。 

@@ 绝 对 不 要 加 热 过 度 。 零件 过 热 时 容易 损坏 。 如 果 焊 接 技术 不 高 .多 次 
重 焊 , 零件 就 容易 因 过 热 而 损坏 。 故 焊接 失败 时 , 不 要 马上 重新 再 焊 , 要 等 
充分 冷却 后 再 重新 开始 。 

@ 把 烙铁 轻 轻 地 与 将 要 焊接 的 零件 和 基板 接触 , 稍稍 加 热 后 焊锡 便 熔 
化 。 焊 锡 熔化 后 , 使 烙铁 离开 零件 。 

@ 图 5.15、 图 5.16 是 在 零件 上 焊 电 线 时 的 顺序 。 先 把 零件 焊 在 线路 板 
上 , 然后 在 电线 上 涂 上 熔化 的 锡 , 再 用 烙铁 与 电线 接触 , 一 边 熔化 电线 上 的 
锡 , 一 边 与 焊 在 线路 板 上 的 零件 的 焊锡 部 接触 , 使 两 部 分 的 焊锡 熔 在 一 起 。 
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图 5.15 加热 熔化 焊锡 图 5.16 在 电线 上 涂 焊 锡 


@@ 像 MP4212 或 电源 用 IC 一 样 , 在 引 脚 较 粗 的 零件 上 焊 电 线 时 , 烙铁 上 
也 要 涂 上 少许 的 锡 , 焊接 方法 与 @ 相 同 。 


本 节制 作 旋转 传感器 , 数量 : 2 个 。 

1. 加 工 安装 电阻 式 传感器 RDC803001A 的 线路 板 

按 图 5.17 的 图 纸 尺 寸 , 用 电 销 在 万 能 板 上 打 孔 , 再 用 钢 锯 锯 断 。 进行 打 
孔 和 锯 断 作业 时 , 都 要 把 线路 板 在 虎 钳 上 固定 结实 。 


(a) 图 纸 (b) 加 工 后 的 线路 板 
图 5.17 RDC803001A 安 装 用 线路 板 


在 RDC803001A 的 背面 , 有 安装 用 的 凸 状 物 , 但 对 于 焊接 来 说 是 无 用 
的 , 所 以 要 用 剪 钳 剪断 。 
像 图 5.18 所 示 的 那样 , 把 RDC803001A 焊 在 加 工 好 的 线路 板 上 , 把 4 个 
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端子 焊 在 线路 板 上 。 焊接 时 , 要 注意 端子 号 的 位 置 关 系 。 
焊接 时 , 要 用 虎 钳 固定 结实 。 焊接 后 , 线路 板 上 的 孔 要 和 RDC803001A 
的 孔 对 齐 。 用 烙铁 把 RDC803001A 的 4 个 端子 焊接 在 线路 板 上 。 


(a) 注 意 端 子 号 的 位 置 (b) 固 定 在 虎 钳 上 (c) 放 烙铁 


图 5.18 RDC803001A 的 焊接 固定 


2. 制 作 旋 转 传 感 器 连接 用 的 连接 器 

数量 : 2 个 。 

首先 , 用 剪 钳 把 2x20 的 针 型 插座 前 成 2x 3 的 针 型 插座 , 拔 掉 1 根 针 , 再 
将 拔 掉 针 的 地 方 用 剪 钳 剪 去 , 用 针 锦 键 刍 去 毛刺 。 如 图 5.19 所 示 。 


me 


(a) 剪 断 针 型 插座 (b) 拔 去 1 根 针 (e) 用 前 钳 剪 去 一 角 


(d) 剪 掉 后 的 形状 (e) 用 什锦 雏 去 毛刺 
图 5.19 针 型 插座 的 加 工 


3. 把 电线 焊接 在 制作 的 接头 上 
首先 准备 一 束 (SHR) 30cm 长 的 电线 , 将 电线 的 两 端 分 别 剥 去 2mm 长 的 
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Be, 涂 上 焊锡 。 在 针 型 插座 的 5 根 针 上 也 涂 上 焊锡 。 再 准备 5 根 5mm 长 的 热 收 
缩 管 。 

把 电线 的 一 端 焊 在 接头 上 。 在 焊接 前 , 把 热 收缩 管 套 在 电线 上 , 如 图 
5.20 (a) 所 示 。 焊接 后 的 样子 如 图 5.20 (b) 和 (c) 所 示 。 再 按 图 5.20 (d) 所 
W, 用 电 吹 风 吹 热 风 , 使 热 缩 管 紧 贴 在 焊接 处 , 如 图 5.20 (e) 所 示 。 


(a) 把 管子 穿 过 电线 (b) 焊 在 接头 上 (e) 焊 接 后 的 样子 


(d) 用 电 吹 风 吹 热 风 (e) 热 缩 管 收缩 后 完成 
图 5.20 在 接头 上 焊 电线 


如 图 5.21 (a) 所 示 , 把 电线 的 另 一 端 焊接 到 传感器 上 。 参 考 图 5.21 
(D) , 把 从 接头 来 的 电线 正确 地 焊接 到 旋转 传感器 的 端子 上 。 


@ | 这 2 根 线 与 电机 焊 
中 | 接 ， 参考 图 5.32 


焊接 的 接头 


(a) 焊 接 到 传感器 上 (b) 传 感 器 和 接头 的 配 线 图 
图 5.21 传感器 和 接头 的 焊接 


4. 在 齿轮 箱 上 安装 旋转 传感器 
如 图 5.22(a) 所 示 , 把 平 齿轮 (42 具 x3mm, 0.5 模 数 ) 固定 在 虎 钳 上 , 把 
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43 的 中 心 孔 用 四 4 的 钻头 扩 筷 。 
把 M4 长 螺丝 按 图 5.22(b) 固 定 在 虎 钳 上 , 按 40mm 的 长 度 用 锯 截 断 。 此 
40mm 的 长 螺丝 将 是 传感器 的 轴 。 


(a) 把 平 齿轮 的 孔 扩 大 (b) 把 长 螺丝 截 成 40mm (e) 传 感 器 的 轴 和 孔 


图 5.22 齿轮 箱 的 加 工 


仔细 看 一 下 传感器 的 轴 孔 , 轴 孔 的 一 部 分 被 切 掉 了 , 如 图 5.22 (c) 所 
示 。 孔 的 直径 为 4mm, 但 因为 被 切 掉 了 一 部 分 , 所 以 作为 轴 使 用 的 长 螺丝 也 
要 切 去 一 部 分 , 如 图 5.23 (a) 所 示 , 只 有 这 样 , 才能 把 齿轮 的 转动 确切 地 传 
递 给 传感器 。 

作为 轴 用 的 长 螺丝 , 要 用 什锦 雏 把 它 的 一 端 加 工 成 长 5mm、 高 3mm 的 
EH. 如 图 5.23 (b) 所 示 , BWW, 直到 成 为 3mm 的 平面 为 止 。 


3 


(a)M4 长 螺丝 的 加 工 方法 (b) 用 什锦 雏 刍 平 


图 5.23 加工 M4 长 螺丝 


为 了 把 旋转 传感器 安装 在 重心 倾斜 用 的 齿轮 箱 上 , 要 按 图 5.24 的 尺寸 
加 工 2 个 齿轮 箱 的 盖子 。 加 工 方法 与 在 第 1 章 制作 齿轮 箱 盖子 的 方法 相同 。 
如 果 没 有 底盘 铵 刀 , 打 8 9 的 孔 是 很 危险 的 , 所 以 要 用 塑料 切断 刀 切 掉 。 打 其 
他 的 孔 时 , 也 要 仔细 阅读 第 1 章 的 相关 内 容 。 一 定 要 注意 安全 。 
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图 5.24 重心 倾斜 用 箱 盖 的 图 纸 尺寸 


把 制作 的 重心 倾斜 用 的 箱 盖 按 图 5.25 所 示 , 用 M3 螺丝 (M3x30) 和 螺母 
固定 在 齿轮 箱 上 。 这 和 在 第 1 章 中 的 组 装 方法 相同 。 HEM is SN 


图 5.25 齿轮 箱 和 旋转 传感器 用 零件 


如 图 5.26 所 示 , 用 M3 螺 丝 、 螺 母 安装 旋转 传感器 。 此 时 , M4 长 螺丝 是 穿 过 
传感器 的 轴 孔 后 才 安 装 旋转 传感器 的 , 所 以 安装 和 位 置 咬合 是 同时 进行 的 。 

把 为 了 确定 位 置 而 穿 人 的 M4 长 螺丝 从 齿轮 箱 里 抽出 来 , 再 次 穿 进去 , 如 
图 5.27 所 示 。 然后, 把 齿 数 为 42 的 齿轮 ,2 个 M4 螺母 依次 套 在 M4 长 螺丝 上 。 
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长 螺丝 的 平面 部 分 
把 M4 长 螺丝 穿 人 传感器 的 轴 孔 

此 时 ， 轴 的 平面 部 分 要 在 旋转 传 
感 器 第 2 个 端子 和 第 4 个 端子 之 间 


日 M3 螺丝 (M3x6) 和 螺母 固定 


图 5.26 安装 旋转 传感器 


M4 长 螺丝 


2 个 M4 螺母 


平 齿轮 (42 齿 x3mm，0.5 模 ) 


图 5.27 螺母 和 齿轮 的 安装 


齿轮 和 2 个 螺母 的 位 置 按 图 5.28 确 定 。 另外, 应 在 外 侧 追 加 1 个 螺母 , HK 
29 所 示 相 互 拧紧 。 这 是 双 螺 母 防 松 法 的 一 种 。 齿轮 和 齿轮 箱 内 的 齿轮 
后 , 再 用 六 角 扳 手 把 齿 轮 固定 在 齿轮 箱 上 , 如 图 5.30 所 示 。 


图 


3% 
咬合 
BKA 


把 螺母 固定 在 外 侧 

jp (由 于 轴 的 转动 ， 在 重心 倾斜 用 齿轮 箱 盖 和 
螺母 之 间 要 留 有 小 的 间隙) 

”内侧 的 螺母 位 置 

~ “(由 于 轴 的 转动 ， 在 重心 倾斜 用 箱 盖 间 要 有 

小 的 间隙 ) 


E 齿轮 和 齿轮 箱 内 齿轮 的 咬合 位 置 


| 


图 5.28 追加 螺母 


5.4 ”旋转 传感器 扩展 线路 板 、 电 机 末 级 前 置 放大 器 的 制作 107 [3 


图 5.29 用 双 螺 母 拧 紧 图 5.30 用 扳手 固定 齿轮 


如 图 5.31 所 示 , 外 侧 也 是 用 双 螺 母 拧 紧 的 , 不 过 应 和 箱 盖 之 间 一 定 留 少 
许 间 际 。 


外 侧 也 用 双 螺 母 拧紧 ， 防 止 松动 。 


图 5.31 外侧 也 用 双 螺 母 拧紧 


如 图 5.32 所 示 , 把 2 根 电 线 焊 在 电机 上 。 


把 0.1hF 的 陶瓷 电容 器 焊 在 电机 上 ， 焊 接 
位 置 在 电机 的 2 个 端子 之 间 。 脚 齿轮 箱 的 
电机 也 同样 。 这 样 可 防止 噪声 。 


把 焊 在 接头 上 的 2 根 电 线 再 焊 到 电机 上 ， 
EG : 对 照 图 5.21 (b ) WD, 2. 


图 5.32 ”把 2 根 电线 焊 在 电机 上 
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脚 齿 轮 箱 上 也 安装 旋转 传感器 , 安装 方法 与 上 述 完全 相同 , 只 是 穿 过 传 
感 器 轴 的 长 螺丝 的 平面 部 分 要 咬合 , 应 按 图 5.33 变 更 。 电 机 的 配 线 要 与 图 
5.21 (b) 中 的 @、@ 相 符 。 


[ 调整 长 螺丝 和 旋转 传感器 轴 孔 的 位 置 ] 
使 机 器 人 的 左 脚 在 前 ， 长 螺丝 的 平面 部 
分 在 旋转 传感器 的 端子 号 1 和 3 之 间 。 


图 5.33 在 脚 齿轮 箱 上 也 安装 旋转 传感器 


本 来 , 写 入 用 的 标准 电线 为 RS232C 电 线 , 但 对 于 较 小 的 机 器 人 来 说 ， 
RS22C 的 接头 太 大 了 , 因此 必须 制作 专用 的 电线 。 把 带 立体 小 插头 的 电线 按 
图 5.34 焊 接 在 DD 辅助 连接 器 9P 上 (焊接 型 ) , 立体 小 插头 的 头 部 .中 部 和 根 
部 分 别 与 D 辅 助 连接 器 的 2 脚 、3 脚 、5 脚 相连 接 。 


ban an : 
3 口 立 体 小 插头 D 辅 助 连接 器 9P 


(a)D 辅 助 连接 器 电路 图 (b)DD 辅 助 连接 器 的 焊接 


图 5.34 D 辅 助 连接 器 
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D 辅 助 连接 器 用 盒子 按 图 $.35 组 装 。 


us 


BN 


(a) 把 焊接 后 的 D 辅 助 连接 器 装 进 盒子 内 (b) 放 上 盖子 用 螺丝 固定 
图 5.35 D 辅 助 连接 器 盒子 的 组 装 


因 要 在 AK1-H8Z3694F 上 连接 旋转 传感器 和 电机 末 级 前 置 放 大 器 等 ， 
需要 制作 扩展 线路 板 。 首先 , 在 板 本 体 上 焊接 AK1-H8Z3694F 的 配件 针 型 
插头 。 因 切换 写 人 程序 要 用 制作 的 扩展 线路 板 侧 的 开关 , 所 以 要 按 图 5.36 那 
样 焊 接 针 型 插头 。 


在 此 面 焊接 针 型 插头 


图 5.36 焊接 针 型 插头 


另外 , 5V 电 源 不 使 用 配件 的 5V 稳 压 器 , 而 使 用 制作 的 扩展 线路 板 侧 的 电 
Wo 按照 AK1-H8/3694F 的 说 明 书 切断 JP1 模 式 , 可 以 用 塑料 切断 刀 切 断 , 如 
图 5.37 所 示 。 另外 , 扩展 线路 板 侧 电源 使 用 最 大 输出 电流 为 1 A 的 TA4805S。 


用 塑料 切断 刀 切 断 卫 1 的 模式 


图 5.37 切断 JP1 的 模式 
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以 下 将 开始 制作 搭载 AKI-H8/3694 的 扩展 线路 板 , 其 电路 图 如 图 5.38 
所 示 。 


DUMMY 
Motor2-VR Motorl-VR 
TINO- 


ON: 启动 
OFF: 正常 


26 立体 小 插 孔 


图 5.38 AK1-H8/3694F 扩 展 线 路 板 电 路 图 


1. 零 件 配置 
图 5.39 是 在 万 能 板 上 的 零件 配置 图 。 在 线路 板 上 , 有 事先 印刷 好 的 
1~25 个 数字 及 A~D 的 字母 , 可 作为 配置 历 件 时 参考 。 
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针 捅 头 (13x2) 立体 小 插 孔 电源 开关 


图 5.39 AKI-H8/3694F 扩 展 线路 板 的 零件 配置 图 (从 零件 侧 看 ) 
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LED 和 电解 电容 器 在 图 5.38 中 指定 了 + 极 和 一 极 , 像 这 样 的 带 有 “+” 
“一 极 的 零件 , 在 配置 时 要 注意 方向 。 三 端子 稳 压 器 TA4805 也 是 有 方向 
的 。 如 图 5.40 所 示 。 


A 有 


足 长 的 为 “+” 足 长 的 为 “+” | nina 
| 2 OUT 
外 
WMO HO 13.2 
(a)LED 的 方向 (b) 电 解 电容 的 方向 (e) 三 端子 稳 压 器 的 端子 号 


图 5.40 各 种 零件 的 方向 


如 果 立 体 小 播 孔 上 有 位 置 咬合 用 的 突起 部 , 要 用 剪 钳 剪 掉 , 如 图 5.41 所 示 。 


(a) 剪 掉 突 起 部 (b) 用 前 钳 剪 掉 针 插座 
图 5.41 剪 掉 突起 部 和 不 要 的 部 分 


图 5.39 中 , 针 插 座 (13x2) 使 用 AK1-H8/3694F 板 的 配件 ; 针 插 座 (4 x 
2) 把 针 插 座 (20x2) 剪 掉 后 使 用 , 如 图 5.41 所 示 ; 针 型 插头 (13) 也 按 同 样 方 
法 加 工 。(20x2) 的 针 型 插头 按 (2x7) 的 尺寸 剪 掉 后 , 再 把 角 部 的 1 根 针 用 
剪 钳 拔 掉 , 把 一 角 剪 掉 后 如 图 5.42 所 示 。 


ape Seu. 


a. 


(a) 把 针 型 插头 的 针 拔 掉 (b) 把 针 型 插头 的 角 部 剪 掉 (e) 完 成 后 的 针 型 插头 
图 5.42 针 型 插头 (13) 的 加 工 
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零件 准备 好 以 后 , 按 图 5.39 所 示 配 置 万 能 板 。 配置 后 的 样子 如 图 5.43 
所 示 。 焊接 前 , 请 再 次 确认 一 下 零件 的 方向 。 最 后 , 用 记号 笔 写 上 “启动 ”、 
Ete. x. ON: 


图 5.43 按 图 5.39 配 置 后 的 零件 


2. 焊 接 
在 背面 进行 焊接 , 示意 图 如 图 5.44 所 示 。 先 说 明 一 下 图 的 看 法 。 


DOOOOOQ 


OOOO@ ‘ = 

OOGOoO6 OOo 

OOOO® O Boocccoc0000000 
OODDDDOOMBCVCOCOOCOCCCOOCOO00N0 
9999900 9m0920099900000990 | 
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OODCOOOOOCCOCONDCOCOO0COO0CC00 
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图 5.44 焊接 示意 图 的 看 法 


(1) e 点 为 焊接 点 。 

(2) 粗 线 和 细 线 的 不 同 之 处 在 于 , 粗 线 把 零件 的 引 脚 作为 配 线 , 细 线 以 
电线 为 配 线 。 因 此 , @ 一 @ 是 零件 的 引 脚 , ®@ 一 @ 是 电线 。 

(3) 注意 线 的 交差 处 : 交差 点 @ 没 有 e, 表示 不 焊接 ; 交差 点 @ 有 e , 表示 要 
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在 此 处 把 电线 的 皮 剥 去 后 焊接 。 因此 , @® 一 @ 的 电线 和 @ 一 @ 的 电线 虽然 是 交 
LH, 但 @-@ 无 电流 通过 , @ 一 @ 也 无 电流 通过 ; 而 9-@、@-@ 之 间 却 有 电 
流通 过 。 微机 是 用 电 来 动作 的 , 如 果 在 不 允许 有 电流 的 地 方 流 有 电流 , 微机 就 
会 不 动作 甚至 损坏 。 焊接 时 , 不 光 要 看 焊接 示意 图 , 还 要 与 图 5.38 仔 细 比 较 。 
现在 , 以 图 5.45 所 示 焊 接 示 意图 为 基准 , 对 配置 好 的 零件 引 脚 进行 焊接 。 
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连接 零件 的 是 ， 配 线 的 地 方 
也 可 参考 图 5.46 的 焊接 照片 
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图 5.45 零件 引 脚 焊接 示意 图 


图 5.46 是 零件 引 脚 的 焊接 实 图 , 画 上 〇 的 地 方 表示 配 线 利用 了 零件 引 脚 ， 
焊接 时 要 与 图 5.45 进 行 比较 。 在 没有 利用 零件 引 脚 的 地 方 , 要 把 引 脚 按 适 当 
的 长 度 剪断 后 再 焊接 。 
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图 5.46 零件 引 脚 的 焊接 实 图 


接 下 来 , 按 图 5.47 一 图 5.54 进 行 电 线 配 线 。 如 在 每 个 电线 涂 上 颜色 话 ， 
最 后 检查 时 就 很 容易 辨认 。 作业 时 也 要 参考 图 5.38。 
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的 配 线 


图 5.50 LED 
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图 5.52 电机 末 级 前 置 放大 器 2 的 配 线 
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图 5.53 旋转 传感器 的 配 线 
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图 5.54 电池 氮 钮 接头 的 配 线 


115 


第 5 章 ”用 微机 自动 控制 


116 


< 


ZN o 


完成 后 的 AK1-H8/3694F 扩 展 线路 板 如 图 5.55 所 


电池 搬 钮 接头 与 干电池 006PLoV) 连 接 | 


个 角 孔 上 ， 安 装 套件 里 


在 线路 板 的 4 
的 螺母 和 垫 片 。 


垫 片 和 螺母 


完成 后 的 AK1-H8/3694F 扩 展 线 路 板 


图 5.55 


制作 电机 末 级 前 置 放大 器 时 , 要 把 需要 的 电子 零件 焊接 在 万 能 板 上 。 图 
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意图 
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5.56 为 零件 配置 
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图 5.56 电机 末 级 前 置 放大 器 零件 配置 示意 图 (零件 面 ) 


ANo 


决定 IC 插座 (14 针 ) 和 MP4212 的 端子 号 码 , 注意 安装 方向 , 如 图 5.57 所 
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国 < 以 此 处 的 贺 形 四 部 为 基准 
6000006 


(a)IC 插 座 端子 号 码 (b)MP4212 端 子 号 码 ( 印 字面 ) 


图 5.57 注意 端子 号 码 


把 2 个 针 型 插头 (5) 和 针 型 插头 (13) 加 工 至 图 5.58 所 示 。 


Ca) 针 型 插头 (13) (b) 针 型 插头 (5) 
图 5.58 准备 针 型 插头 


零件 准备 好 以 后 , 按 图 5.56 在 万 用 线路 板 上 配置 。 图 5.59 为 实际 配置 
照片 。 


MP4212 印 字 的 
此 处 为 圆 形 四 部 一 面 为 这 一 侧 


图 5.59 配置 零件 后 


焊接 前 , 要 再 次 确认 一 下 零件 的 方向 。 不 光 要 看 示意 图 , 还 要 和 线路 图 


的 电机 末 级 前 置 


成 后 
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此 行 电线 配 线 。 


小 过 
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意图 为 基准 , 焊接 零件 的 引 脚 , 如 图 5.61 所 


不 
ZIN o 


焊接 
, 按 图 5$.62 一 图 5.69 所 


ZIN 


5S MRAZE 
以 图 5.60 所 
接 下 来 
线路 板 如 图 5.70 所 


(图 5.10、 图 5.11) 相 比 较 , 焊接 方法 也 要 再 次 确认 。 
放大 器 
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图 5.62 电源 + 极 配 线 
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图 5.69 


电池 箱 的 配 线 
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圆 形 止 处 


把 74HC00 插 入 14 针 IC 插 座 内 ， 
使 圆 形 止 处 在 下 方 。 


REI SS 


图 5.70 电机 末 级 前 置 放大 器 线路 板 


首先 , 制作 连接 电机 末 级 前 置 放 大 器 线路 板 和 AK1-H8/3964F 扩 展 线 
路 板 的 电线 。 把 图 5.71 (a) 所 示 加 工 好 的 2 个 针 型 插座 (13) 和 15cm 长 的 12 
芯 电 线 准 备 好 。 像 图 5.20 的 (2x3) 针 型 插座 那样 , 穿 过 热 收 缩 管 后 焊 热电 
线 。 电 线 的 芯 数 较 多 , 如 果 像 图 5.71 (b) 所 示 的 那样 , 把 针 形 插座 插 到 预先 
做 好 的 针 型 插头 上 的 话 , 作业 将 简单 得 多 。 图 5.71 (c) 是 完成 后 的 电线 。 之 
后 , 将 把 扩大 线路 板 和 电机 末 级 前 置 放大 器 线路 板 安 装 到 机 器 人 上 , 再 用 此 
电线 连接 。 


(a) 准 备 2 个 针 型 插座 (13) 和 15cm 长 的 12 芯 电线 


(b) 插 入 针 型 插头 (c) 完 成 后 的 电线 
图 5.71 制作 连接 电线 
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接 下 来 , 用 ABS 板 制作 安装 在 电机 末 级 前 置 放大 器 线路 板 和 AK1- 
H8A3694F 线 路 板 后 面 的 保护 板 。 如 图 5.72 所 示 , 把 万 能 板 放 在 ABS 板 上 ， 
用 记号 笔划 出 一 边 的 线 , 用 打 孔 机 打上 记号 , 在 充分 注意 安全 的 情况 下 用 电 
钻 打 4 个 孔 , 再 用 塑料 切断 刀 切 断 。 

制作 2 块 图 5.72 所 示 的 保护 板 。 其 中 的 1 块 按 图 5.73 所 示 用 电钻 打 $ 3.2 
的 孔 , 再 从 它 的 背面 穿 4 根 M3 螺丝 (M3x6) , 装 上 10mm 支 撑 柱 套件 里 的 
SHEE. 图 5.74 中 已 经 安装 了 3 个 支撑 柱 , 螺母 将 在 安装 电机 末 级 前 置 放大 
器 线路 板 时 使 用 。 


8.5 


©): ws. O 
g 
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图 5.72 保护 板 的 制作 图 5.73 在 保护 板 上 追加 孔 


图 5.55 中 , AK1-H8/3694F 上 已 经 安装 了 支撑 柱 , 所 以 把 制作 的 保护 板 
从 背面 用 4 根 M3 (M3x6) 螺丝 安装 。 

把 M3 螺丝 (M3x12) 和 螺母 固定 在 重心 倾斜 箱 的 孔 上 (在 第 3 章 制 作 
的 ) , 其 位 置 如 图 5.75 所 示 。 再 按 图 5.76 所 示 , 安装 电池 安装 用 箱 和 曲柄 杆 。 
安装 顺序 与 第 3 章 相同 , 只 是 要 把 曲柄 杆 按 近 于 水 平 的 方向 安装 , 曲柄 杆 有 3 


ee ei | Pa e 


图 5.74 安装 支撑 柱 图 5.75 在 重心 倾斜 箱 上 安装 M3 螺 丝 
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个 孔 的 一 侧 为 传感器 的 一 侧 。 按 图 5.77 所 示 安 装 齿轮 箱 , 安装 顺序 与 第 3 章 
相同 。 

在 重心 倾斜 箱 上 安装 电机 末 级 前 置 放大 器 线路 板 用 的 保护 板 , 如 图 
5.78 所 示 。 把 在 图 5.75 中 安装 的 螺丝 穿 过 在 图 5.73 里 追加 的 孔 里 , 再 用 螺母 
固定 。 再 按 图 5.79 安 装 电 机 末 级 前 置 放大 器 的 线路 板 , 用 秋月 电子 的 10mm 
支撑 柱 套件 里 的 螺母 固定 。 


图 5.76 电池 安装 用 箱 图 5.77 齿轮 箱 的 安装 图 5.78 线路 板 衬 板 的 安装 


如 图 5.80 所 示 , 在 电池 安装 箱 的 上 部 , 用 粘 接 剂 把 1 块 ABS 板 粘 牢 。 被 
粘 接 的 ABS 板 是 在 第 3 章 中 制作 的 , 此 处 使 用 的 是 余下 的 图 3.26 材 料 @。 

电池 也 和 第 3 章 相 同 , 在 电池 安装 箱 的 侧面 用 双 面 胶带 粘 上 .。 在 上 部 把 
AK1-H8Z3694F 扩 展 线 路 板 的 保护 板 用 双 面 胶带 粘 上 。 

如 图 5.81 所 示 , 把 从 电机 来 的 2 组 电线 及 连接 扩展 线路 板 和 电机 末端 前 
置 放大 器 线路 板 的 1 组 电线 分 别 插 入 连接 器 。 为 了 不 使 连接 器 的 方向 搞 错 ， 
曾经 加 工 了 1 角 , 请 注意 它 的 方向 。 


图 5.79 ”电机 末端 前 置 放大 器 线路 板 的 安装 图 5.80 ”在 电池 安装 箱 的 上 部 粘贴 板子 
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连接 扩大 线路 板 和 电机 未 级 前 置 放大 器 基板 的 电线 


脚 电机 连接 


重心 倾斜 电机 
连接 器 


i 


hosel 


(a) 在 上 部 贴 扩大 线路 板 (b) 完 成 后 的 右 侧面 (c) 完 成 后 的 左 侧面 


(d) 完 成 后 的 前 面 (e) 完 成 后 的 斜 方向 


图 5.81 完成 后 的 机 器 人 


从 这 一 节 开 始 编写 控制 双 足 步行 机 器 人 的 程序 。 编程 使 用 的 语言 为 C 语 
言 。C 语 言 是 控制 程序 广泛 使 用 的 语言 , 开发 环境 丰富 , 使 用 方便 。 本 书 中 使 
用 免费 软件 GCC DeveloPer Lite 的 开发 环境 进行 程序 编写 。 
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关于 程序 的 写 人 及 向 微机 的 输入 方法 , 将 在 5.5.2 节 加 以 说 明 。 对 于 初 
学 者 来 说 , 无 论 如何 也 要 把 本 书 的 程序 写 人 微机 , 请 机 器 人 动 一 动 , 来 体会 
一 下 控制 的 乐趣 及 C 语 言 的 方便 。 

本 书 的 双 足 步行 机 器 人 步行 要 点 , 如 在 第 3 章 实验 的 那样 , 通过 脚 动作 
的 联动 使 重心 倾斜 , 始终 把 身体 的 重心 放 在 一 只 脚 的 支撑 区 , 例如 , 为 了 使 
右 脚 抬 起 向 前 迈步 , 必须 : 

OA BIE BI; 

© (i BL 1 Ae fo FY 

@ 向 前 迈 右 脚 。 

把 这 些 用 微机 进行 控制 时 , 相应 的 时 序 如 图 5.82 所 示 。 


® ie | 
右 脚 


© kad 
kad 心 倾 


D | 用 传感器 检测 到 左 脚 在 前 方 。 


图 5.82 用 微机 控制 的 时 间 


基本 程序 为 以 下 4 个 : 

@ 让 脚 电 机 转动 的 程序 

@ 让 重心 倾斜 电机 转动 的 程序 

@ 从 旋转 传感器 上 读 出 脚 电机 转动 位 置 的 程序 ， 

@ 从 旋转 传感器 上 读 出 重心 倾斜 电机 转动 位 置 的 程序 。 

ABA, 让 我 们 编写 让 电机 转动 的 程序 吧 ,。 已 制作 出 的 双 足 步行 机 器 
人 的 控制 电路 为 HH 电 桥 电 路 (图 5.10、 图 5.11) 的 IN0-0~IN0-3 和 IN1- 
0 一 IN1-3, 分 别 用 电缆 线 与 AK1-H8/3694F 扩 展 线路 板 的 IN0-0~IN0-3 和 
INI-0~INI-3 连 接 在 一 起 , 如 图 5.83 所 示 。 
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AKI-H8/3694F H 电 桥 电路 
扩大 线路 板 Nio (电机 末 级 前 置 放大 器 ) 


图 5.83 AK1-H8/3694F 扩 大 线路 板 和 朝 电 桥 电路 的 连接 


微机 的 IZO 端 口 和 互 电 桥 电 路 相连 接着 , 所 以 从 IAO 端 口上 发 出 “0” 
和 “1” 的 信号 (“0” 即 为 0V,“1” 为 5V) ,用 来 控制 H 电 桥 电 路 的 ON 和 
OFF, 

IN0-0~IN0-3、IN1-0~IN1-3 程 序 中 具体 使 用 的 AK1-H8/3694F 的 端 
口号 码 为 


也 可 以 参看 AK1-H8/3694F 附 带 的 资料 。 
因此 , 如 果 把 表 5.1 按 在 实际 操作 程序 中 使 用 的 I/O 端 口 重新 编写 一 次 ， 
则 变 成 表 5.3 和 表 5.4。 
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表 5.3 ”从 微机 端口 发 出 的 控制 脚 电机 的 信和 号 


E # 1 0 1 0 
反 转 0 1 0 1 
制动器 . 0 0 1 1 
停 止 0 0 0 0 
禁止 1 i} * * 1 
禁止 2 * 1 1 * 
禁止 3 1 1 1 1 


表 5.4 ”从 微机 端口 发 出 的 控制 重心 倾斜 电机 的 控制 信号 


脚 电 机 正 转 时 , 按 表 5.3 的 正 转 状态 执行 程序 。 另 外 , 为 了 不 执行 禁止 状 
AS, 请 注意 端口 上 发 出 信号 的 顺序 : 


同样 , 反 转 时 , 按 表 5.3 的 反 转 状态 执行 
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C 语 言 程序 , 就 是 这 种 函数 的 汇集 。 就 像 使 电机 正 转 、 反 转 函 数 一 样 , 是 
把 一 个 做 大 量 工作 的 程序 作为 函数 命名 定义 的 。 要 使 函数 运行 , 就 要 在 想 
运行 的 位 置 表示 出 想 运行 的 函数 名 。 为 了 便于 理解 函数 的 定义 和 运行 , 可 以 
只 把 使 电机 正 转 程序 组 合 起 来 试 一 试 。 另 外 , 在 C 语 言 中 , main () 这 个 函 
数 是 个 特别 的 函数 : 程序 运行 时 , 一 定 是 先 执行 main () 函数 。 

以 后 的 程序 单 , 可 以 在 株式 会 社 ohmsha (http: //www.ohmshco.jp/) 
的 网 页 中 下 载 。 

程序 单 5.1 电机 的 正 转 程序 


微机 与 计算 机 使 用 RS232C 通 信 , 如 图 5.84 所 示 。 如 果 把 


表述 在 程序 开头 的 话 , 则 不 可 以 利用 为 RS232C 通 信 所 预备 的 函数 。 


RS232C 通 信 


从 微机 输送 到 
计算 机 


图 5.84 微机 和 计算 机 使 用 RS232C 通 信 


例如 , 往 计算 机 屏幕 上 输入 “sensorl” 文字 列 后 , A/D 变 换 端口 上 连 
接 的 旋转 传感器 的 数值 便 被 输入 到 微机 , 计算 机 屏幕 上 显示 出 来 的 程序 如 


计算 机 和 微机 通信 对 机 器 人 进行 控制 的 程序 刊载 于 程序 单 5. 2。 
程序 单 5.2 ”计算 机 和 微机 通信 对 机 器 人 进行 控制 


用 微机 自动 控制 
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RRE MLN LAE TL AS A, 是 由 输入 的 程序 控制 的 。 除 了 在 本 书 中 
使 用 的 C 语 言 之 外 , 还 有 几 种 程序 语言 。 无 论 使 用 何 种 语言 编程 , 对 微机 来 
说 能 理解 的 只 有 机 械 语 , 因此 所 编写 的 程序 要 翻译 成 机 械 语 之 后 再 输送 给 
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微机 。 要 编写 程序 就 需要 编译 软件 , 以 及 其 他 各 种 软件 。 总 的 来 说 ， 所 需要 
的 软件 最 少 有 以 下 3 种 。 

@ 编 辑 : 在 计算 机 上 编写 程序 的 软件 。 

@ 编 译 : 把 写 好 的 程序 翻译 成 机 械 语 的 软件 。 

ORY: 把 翻译 成 机 械 语 的 程序 写 入 微机 的 软件 。 

GCC DeveloPer Lite 软 件 兼 有 这 3 种 功能 , 是 Best Technology 公 
司 的 免费 软件 , 可 以 在 WinDows 上 编辑 和 编译 源 文 件 , 并 可 利用 配套 的 给 
人 工具 向 微机 输入 , 非常 方便 。 

其 具有 初学 者 也 能 轻松 使 用 的 开发 环境 , 就 利用 这 个 GCC DeveloPer 
Lite 来 编写 程序 吧 。 

用 GCC DeveloPer Lite 编 写 程序 的 顺序 如 下 ， 

@ 在 计算 机 中 安装 GCC DeveloPer Lite。 

l 
@#EGCC DeveloPer Lite 的 编辑 页 输入 程序 。 


| 
@ 用 GCC DeveloPer Lite 编 译 程 序 。 


@ 把 翻译 成 机 械 语 言 的 程序 用 GCC DeveloPer Lite 写 入 微机 。 


l 
@ 执 行 输入 到 微机 上 的 程序 。 
Best Technolgy 公 司 的 网 页 上 (http: //besttechnology.co.jp) 即 
可 下 载 到 GCC DeVeloPer Lite 软 件 , 下 载 结束 后 , 保存 在 桌面 上 , 双击 
GCC DeveloPer Lite Setup 图 标 即 可 安装 。 其 安装 步 又 如 图 5.85 所 示 。 


选择 Japanese， 点 击 “OK” r3 
| =] ge FAA CIPI | 
— l won 
er aien Mean 在 表示 的 “分 才 了 口 分 ” 上， 点击 “次 入 ” 
| (对 话 ) (下 一 步 ) 


图 5.85 GCC DeveloPer Lite 的 安装 步骤 
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@ 使 用 许可 书 


读 使 用 许可 者 ， 选 择 “同意 才 列 ” 
同意 ) 


， 点 击 “ 次 入” 
(下 一 步 ) 


Mu PUBb 
Version 2 ne 1991 
| eve 9 100a, 1000 Fren Seti Fda 
9 Temple eh Sn in 021-1307 USA 
verbatim copies 


MeSH, Ah Wwa” 
(下 一 步 》 


安装 组 件 为 文件 安装 ， 点 击 “ 次 入 ” 
CN 


程序 组 别 的 指定 按 指 示 进 行 ， 点 击 “ 次 入 ” 
《下 一 步 》 


图 5.85 GCC DeveloPer Lite 的 安装 步 又 ( 续 ) 
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@@ 选 择 追加 任务 
(任务 ) (下 一 次 ) 
追加 儿 又 夕 是 “在 桌面 上 做 成 图 标 ”OK， 点 击 “次 和” 
@ 安 装 准备 完了 
安装 准备 完了 的 画面 ， 点 击 “ 之 又 上 一 儿 ” 
(安装 ) 


安装 进行 中 。 到 安装 完了 需要 一 些 时 间 ， 慢 慢 等 待 


] 了 
Ee le 


PAPIET TIISAT EYL TOA, 


安装 完了 ， 点 击 “ 完 了 ” 
(结束 ) 


图 5.85 GCC DeveloPer Lite 的 安装 步骤 ( 续 ) 


到 此 , 构成 了 能 够 使 用 GCC DeveloPer Lite 的 环境 。 从 开始 菜单 中 启 
动 GCC DeveloPer Lite, 屏幕 上 显示 图 5.86 所 示 画 面 , 询问 所 使 用 的 微 
机 类 型 。 选择 “H8/3694F (Ting) 内 部 程序 存储 ROM” 后 点 击 “OK”, 从 
第 2 次 以 后 , 即使 启动 GCC DeveloPer Lite 也 不 再 进行 确认 。 

如 果 在 此 处 没有 选择 “H8/3694F 内 部 程序 存储 ROM”, 以 后 在 工具 菜 
单 里 也 可 以 进行 设 定 。 
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(a) 目标 选择 画面 (b) 目标 选择 确认 


图 5.86 GCC DeveloPer Lite 开 始 前 的 设 定 


图 5.87 为 编写 程序 时 使 用 的 画面 


这 个 窗口 显示 编译 结果 。 
编译 错误 及 警告 也 在 此 处 显示 。 


wi Tiem Aea HaT) RDS AROM 


图 5.87 GCC DeveloPer Lite 开 始 的 画面 


在 这 个 程序 的 输入 画面 上 , 把 刚才 的 程序 单 5.2 输 入 进去 。 除 注释 之 
Dh, 程序 为 半角 数字 。 

输入 完了 后 , 一 定 要 保存 。 从 菜单 的 “文件 ”里 选择 “文件 名 保存 ”, 把 
文件 名 输入 后 , 点 击 “OK”。 预先 选 好 保存 地 点 , 如 果 需 要 , 可 先 新 建文 件 
夹 。 预先 做 好 保存 C 语 言 源 文件 的 文件 夹 以 便于 管理 , 文件 名 写 上 自己 容易 
管理 的 名 字 。 
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fe POR, 从 菜单 的 “编译 ”里 选择 “建立 ”, 编译 画面 如 图 5.88、 图 5.89 
所 示 。 如果 编 译 成 功 , 则 窗口 提示 编译 成 功 ; 如 果 有 错误 , 就 要 仔细 阅读 内 
容 、 进 行 修改 。 
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(a) 保 存 源 文件 (b) 编 译 的 画面 


图 5.88 ”编写 程序 
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图 5.89 编译 完了 


经 常 出 现 的 错误 如 下 。 

四 半角 为 全 角 。 程序 为 半角 数字 , 之 中 如 掺 杂 全 角 数 字 的 话 , 则 成 为 错误 。 

Ons “;” 遗漏, 函数 的 最 后 的 “}” 遗 漏 。 

@ 注 释 行 /x+*/ 及 // 不 齐全 。 

把 事先 制作 的 电缆 线 RS232C 连 接 器 插入 计算 机 的 RS232C 连 接口 , 立 
体 插头 插入 微机 侧 的 立体 微型 插口 。 

编译 成 功 后 , 把 机 械 语 言 的 程序 写 入 微机。 如 图 $.90 所 示 , 点 击 写 入 程 
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序 的 图 标 , 写 人 程序 便 被 启动 。 此 时 , 写 人 程序 的 目标 应 该 为 3664, 如 果 不 
是 的 话 , 则 按 下 述 方法 把 目标 变 为 3664。 

在 Flash writer4.0 栏 中 , 点 击 右键 显示 菜单 , 选择 菜单 中 的 “FW 环 
境 设 定 ”, 在 “CPU 类 型 ” 项 上 点 击 “3664”, REAR, BS, COM 端口 是 
与 串 行 电缆 线 相 连接 的 端口 号 。 端口 的 选择 要 正确 。 

接 下 来 , 把 微机 侧 的 拨 动 开关 拨 到 启动 侧 , 把 电源 开关 打 在 ON (IA) 
位 置 , 点 击 “ 写 入 ”, 则 开始 向 微机 写 人 程序 。 

写 入 结束 后 , 把 微机 的 电源 开关 打 在 OFF ( 断 开 ) 位 置 。 


写 入 的 图 标 


CPU 类 型 选择 3664 


选择 连接 串口 电缆 线 的 端口 


| 


(a) 启 动 写 入 
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ae 
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(b) 把 拔 动 开关 拔 到 启动 侧 ， 把 电源 开关 ON( 闭 合 ) (c) 写 人 成 功 


图 5.90 BAG 


请 再 次 检查 一 下 程序 和 电路 有 无 错误 , 特别 是 与 电机 驱动 程序 有 关 的 
错误 , 有 时 会 损坏 电机 驱动 程序 。 如 无 错误 , 可 以 执行 。 

因 是 微机 和 计算 机 的 通信 , 所 以 要 先 把 计算 机 启动 起 来 。 按 图 5.91 所 示 
步骤 设置 与 微机 通信 软件 “超级 终端 ”。 
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=¥ = 一 ~ 通信 一 -超级 终端 
开始 一 = 所 有 程序 一 ~ 附件 一 ~ 通信 OMMEL 
名 称 输入 h8_tiny， 点 击 “OK” 


a 连接 方法 上 选择 连接 串口 端口 的 号 ， 在 图 中 选择 了 
TASTO: | ‘ COMI1。 


SEES. 
HADEN: 


COMIZIO F 4 


[K-o | 


A 7 


F-a MD: [8 


接 下 去 ， 是 端口 的 设置 画面 ， 把 波 特 率 设 置 为 57600， 
数据 波 特 为 8， 奇 偶 性 为 无 ， 停 止 波 特 为 1， 流 量 控制 
AA, Rit “OK” . 


HFW: [Fal 


这 样 ， 启 动 超级 终端 ， 保 存 设 定 。 从 菜单 的 “文件 ” 
里 选择 “保存 在 …”。 


图 5.91 超级 终端 的 设置 
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从 下 次 开始 , 当 点 击 桌面 上 的 图 标 时 , 超级 终端 将 被 启动 。 超级 终端 启 
动 后 , 将 执行 微机 。 执行 微 机 时 , 要 把 微机 的 拨 动 开关 拨 向 正常 侧 , 使 电源 
闭合 (ON) , 如 图 5.92 所 示 。 于是, 在 超级 终端 的 画面 上 , 将 显示 出 下 列 从 
微机 送 来 的 字符 : 


图 5.92 使 线路 板 在 正常 侧 , 电源 ON (闭合 ) 


根据 这 个 菜单 , 当 从 键盘 输入 1~9 的 数字 时 , 便 被 微机 发 射 、 处 理 。 看 
看 源 程序 单 5.2 就 会 明白 , Menu 的 各 项 动作 如 下 : 


若 输 入 数字 键 的 7, 屏幕 画面 上 则 会 出 现 像 SENSOR1=j235 一 样 , 把 脚 
电机 旋转 传感器 的 值 用 3 位 数 显示 出 来 。 

接着 输入 数字 1, 则 脚 电 机 转动 ; 停止 时 , 则 要 输入 数字 键 的 3 。 再 次 答 
入 数字 7, 则 屏幕 画面 上 显示 SENSOR1=200, 值 会 变 大 变 小 呢 ! 这 是 因为 
随 着 旋转 传感器 的 转动 , 出 现 了 所 对 应 的 变化 值 。 
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那么 , 为 了 用 微机 控制 双 足 步行 机 器 人 , 就 必要 把 脚 的 位 置 和 重心 倾斜 
的 位 置 登记 到 程序 中 去 , 在 程序 单 5.2 中 的 下 列 3 行 (程序 单 5.3) 就 是 登记 
在 程序 中 的 部 分 。 
程序 单 5.3 


接 下 来 , 将 确定 这 些 数 值 。 

首先 , 确定 @ 右 脚 在 前 方位 置 时 的 旋转 传感器 的 数值 。 接着 刚才 的 程序 
输入 数字 1, 脚 动作 了 。 当 右 脚 向 前 迈 出 后 , 输入 数字 3 使 它 停止 。 如 果 失 败 ， 
则 反复 重复 几 次 , 直到 使 它 能 做 出 右 脚 在 前 的 状态 。 做 好 以 后 再 输入 数字 
7, 使 旋转 传感器 的 数值 显示 出 来 , 并 把 此 数值 记录 下 来 。 

此 时 , 暂停 一 下 程序 , 把 微机 的 开关 打开 OFF 位 置 , 结束 超级 终端 . 点 
击 超级 终端 的 画面 右上 的 “x” 就 可 结束 。 

启动 GCC DeveloPer, 读 程序 。 变更 程序 中 的 


例如 , 现在 为 “67”, 把 “67” 用 刚才 记录 下 来 的 数值 替换 。 注意 : 要 用 半角 
输入 , 替换 后 保存 。 

接着 , 确定 @ 左 脚 在 前 方位 置 时 的 旋转 传感器 的 值 。 再 次 双击 桌面 上 的 
H8/ATing 图 标 , 超级 终端 启动 后 把 微机 的 开关 打 向 ON, 在 显示 出 的 菜单 里 
输入 数字 1, 脚 动作 。 当 左 脚 向 前 迈 出 后 , 输入 数字 3 使 它 停 止 。 如 果 失 败 , 则 
反复 重复 几 次 , 直到 使 它 做 出 左 脚 在 前 的 状态 。 做 好 以 后 再 输入 数字 7, 使 
旋转 传感器 的 数值 显示 出 来 。 和 刚才 一 样 , 把 显示 出 来 的 旋转 传感器 的 值 
替换 : 


其 中 的 221, 注意 用 半角 和 输入。 
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最 后 确定 @ 重 心 倾斜 在 中 心 位 置 时 的 旋转 传感器 的 值 。 和 刚才 一 样 , 在 
显示 的 菜单 里 输入 数字 4 或 5 等 , 使 重心 倾斜 的 位 置 处 于 中 间 位 置 ( 既 不 偏 
左 又 不 靠 右 的 位 置 ) 。 当 处 于 中 间 位 置 时 , 输入 数字 3 使 它 停止 。 如 果 失 败 ， 
则 反复 重复 几 次 , 直到 使 它 处 在 中 间 状 态 。 做 好 以 后 输入 数字 8, 显示 传 感 
器 的 数值 , 把 此 数值 替换 : 


其 中 的 104, 注意 要 用 半角 输入 。 

以 上 是 用 程序 控制 本 书 中 的 双 足 步行 机 器 时 最 重要 的 部 分 。 

1. 不 定 值 区 的 避免 方法 

本 书 中 的 机 器 人 使 用 的 电阻 式 旋 转 传感器 为 360" 转动 , 由 于 旋转 传 感 
器 的 输出 值 是 不 连续 的 , 所 以 进行 控制 时 要 充分 理解 这 个 特点 后 再 使 用 。 

使 电机 转动 , 连续 输出 旋转 传感器 的 值 , 此 值 的 输出 范围 在 0 一 255 之 
间 。 如 果 输 出 的 值 是 连续 的 话 , 则 为 0.1:2.3…254:255.0.1.2.3…; 
如 果 使 用 的 旋转 传感器 为 RDC803001A, 则 输出 的 数值 为 0.1.2.3……: 
254.:255 : 口 : 信 :10.123… 口 :人 和信: OW KEE, 虽然 传感器 在 360° 之 
间 转 动 , 但 也 有 无 电阻 的 区 域 , 当 传感器 通过 此 区 时 , 其 输出 值 便 为 不 定 值 。 

编程 时 , 有 不 定 值 的 时 候 , 所 以 有 必要 先 理解 旋转 传感器 的 特性 。 

例如 , 当 腿 部 的 移动 传感器 的 数值 为 170 时 , 表示 重心 向 右倾 斜 , 假设 
有 步行 控制 的 程序 存在 。 当 传感器 的 值 由 168 :169 :170 (逐渐 增加 到 170) 
时 , 表明 正在 正确 地 控制 着 重心 向 右倾 斜 。 但 是 , 旋转 传感器 的 输出 值 为 
253.254.255 后 进入 不 定 值 区 , 也 有 可 能 输出 170, 此 时 虽然 传感器 的 值 为 
170, 如 果 重 心 向 右倾 斜 的 话 , 则 不 能 正确 控制 。 

因此 , 编程 时 要 设法 避 开 旋转 传感器 输出 值 的 不 定 值 区 。 现 有 2 种 方法 。 

@@ 当 重心 倾斜 的 齿轮 箱 处 于 中 间 状 态 (不 偏 左 也 不 偏 右 ) 时 , 使 传感器 
的 值 在 128 附 近 (传感器 的 中 间 值 ), 安装 长 螺丝 通过 传感器 的 位 置 。 在 程 
序 单 5.3 中 , 此 值 为 104, 如 果 以 此 值 为 标准 的 话 , 即便 重心 往 左 、 往 右倾 斜 , 传 
感 器 上 的 值 = 中 间 值 填 60=104 土 60=44 一 164, 这 样 便 可 以 避 开 不 定 值 区 。 

@ 如 果 在 脚 部 安装 旋转 传感器 , 因此 处 的 传感器 要 转动 1 圈 , 故 其 
输出 值 是 不 可 能 避 开 不 定 值 区 的 。 采取 的 方法 是 , 如 果 旋 转 传感器 在 向 
数值 增加 的 方向 转动 4 双 足 步行 机 器 人 前 进 的 方向 ) , 则 输出 的 值 为 … 
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254°255-L]‘A:O:-0:1, 经 过 不 定 值 区 时 , 一 旦 确认 输出 值 为 0 就 等 待 
准确 的 数值 ; 若 传感器 在 向 数值 减少 的 方向 转动 (后 退 方向 ) , 则 输出 数值 
为 …3:2:1:0: 口 :和信 : 今 255 :254…, 经 过 不 定 值 区 时 , 一 旦 确认 输出 值 为 
255 就 要 等 待 准确 的 数值 。 

因此 , 对 程序 单 5.3 的 部 分 , 如 果 接 近 本 书 的 值 , 要 变更 程序 的 话 , 只 
要 变更 程序 单 5.3 的 部 分 即 可 。 在 旋转 传感器 的 安装 说 明 处 (图 5.26、 图 
5.33) , 也 涉及 旋转 传感器 长 螺丝 平坦 部 加 工 部 分 的 方向 问题 , 此 处 的 安装 
位 置 决定 了 程序 单 5.3 的 值 。 

2. 脚 部 旋转 传感器 的 调整 

如 果 对 程序 有 自信 的 话 , 在 理解 了 方法 @ 和 @ 后 , 可 根据 旋转 传感器 的 
安装 位 置 变更 程序 ; 如 果 对 程序 还 不 太 熟 练 , 则 可 以 通过 调整 机 器 人 本 体 
来 达到 程序 单 5.3 的 值 , 方法 如 下 。 

先 启动 超级 终端 , 使 写 人 了 程序 单 5.2 的 微机 执行 。 

脚 部 旋转 传感器 的 调整 如 下 。 

OMS BAT, 使 传感器 的 值 显示 出 来 。 如 果 不 是 221 的 话 , 再 从 菜 
单 里 输入 1, 使 脚 部 电机 转动 。 转动 到 适当 位 置 时 输入 3, 使 它 停止 。 从 菜单 里 
输入 7, 确认 传感器 的 值 。 这 样 反 复 操作 , 直到 把 传感器 的 值 调 到 221 为 止 。 

@ 旋 转 传 感 器 的 值 为 221 停 止 后 , 调整 机 器 人 脚 的 位 置 。 先 用 六 角 扳手 

(齿轮 箱 的 配件 ) 拧 松 作为 脚 齿 轮 箱 轴 的 六 角 螺 丝 , 如 图 5.93 所 示 。 

要 使 脚 能 自由 活动 , 使 左 脚 在 前 (图 5.94) 。 此 时 , 要 注意 不 要 使 旋转 传 

感 器 转动 。 当 左 脚 在 前 时 , 再 把 刚才 拧 松 的 螺丝 旋 紧 固定 。 


al 


六 角 螺 丝 


图 5.93 齿轮 箱 的 六 角 螺 丝 


5.5 程 序 145 > 


sH 
_ 
cy i 
(J e 上 


eon 


(a) 转 动 传感器 值 为 211 时 的 状态 (b) 转 动 传感器 值 为 104 时 的 状态 
图 5.94 由 旋转 传感器 值 调整 状态 


至 此 , 脚 部 旋转 传感器 调整 完毕 。 

3. 重 心 倾斜 传感器 的 调整 

重心 倾斜 传感器 的 调整 方法 与 脚 部 旋转 传感器 相同 , 如 下 。 

@ 从 菜单 中 输入 8 , 使 传感器 的 值 显示 出 来 。 如 果 不 是 104 的 话 , 再 从 菜 
单 里 输入 4 或 5 使 重心 倾斜 电机 转动 。 转 动 到 适当 位 置 时 输入 6, 使 它 停止。 
从 菜单 里 输入 8, 确认 传感器 的 值 。 这 样 反复 操作 , 直到 把 传感器 的 值 调 到 
104 为 止 。 如 果 难 以 调节 的 话 , 可 以 从 机 器 人 身上 印 下 来 进行 调节 (注意 : 不 
要 拆 掉 电 线 ) 。 

@ 调 整 重心 倾斜 齿轮 箱 。 先 用 六 角 扳 手 拧 松 作为 重心 倾斜 齿轮 箱 轴 用 
的 六 角 螺 丝 , 齿轮 箱 能 自由 活动 , 曲柄 臂 杆 处 于 水 平 位 置 。 此 时 要 注意 , 不 要 
使 旋转 传感器 转动 , 曲柄 杆 成 水 平 位 置 以 后 , 再 用 刚才 的 螺丝 重新 固定 好 。 

到 此 , 重心 倾斜 传感器 的 调整 完毕 。 

4. 实 现 双 足 步 行 的 程序 

现在 , 为 实现 双 足 步行 的 零件 编写 程序 。 在 重心 倾斜 上 , 必要 的 函数 有 
以 下 4 个 : 
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使 脚 动作 的 必要 的 函数 有 以 下 4 个 : 


如 前 所 述 , 脚 部 电机 的 旋转 传感器 , 因 其 输出 值 有 时 处 于 不 定 值 区 , 所 
以 必要 的 函数 有 2 个 : 


步行 的 基本 函数 有 以 下 4 个 : 


各 函数 的 定义 如 下 : 
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把 函数 进行 组 合 后 , 可 以 编写 前 进 直 线 步 行 、 后 退 直线 步行 、 前 进 右 转 
弯 、 后 退 右 转弯 的 程序 。 
例如 , 前 进 直 线 步行 的 函数 可 以 由 以 下 函数 组 成 : 


if 
alu my 
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另外 , 追加 以 0.25s 为 单位 的 等 待 时 间 的 函数 ， 


以 上 的 程序 追加 在 程序 单 5.2 里 。 

把 程序 开头 的 函数 追加 在 声明 处 , 声明 的 顺序 可 以 任 定 。 追加 函数 定义 
时 , 可 以 在 main ( ) { 1 函数 的 后 面 任何 地 方 , 定义 函数 的 顺序 可 以 任 定 。 

上 述 函 数 在 程序 单 5.4 中 , 把 它 编写 在 程序 单 5.2 里 的 菜单 里 ， 


在 此 处 追加 程序 单 5.4 


程序 单 5.4 追加 Menu2 的 程序 
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walk _ kosin(3); 


5.6 用 微机 自动 控制 进行 


现在 开始 进行 步行 实验 。 使 用 在 前 节 介绍 的 函数 也 可 以 编写 转弯 用 的 
程序 , 也 可 以 从 株式 会 社 ohmsha 的 网 页 中 下 载 。 

1. 执 行程 序 

双击 计算 机 画面 上 的 h8-ting 图 标 , 启动 超级 终端 。 把 微机 的 拨 动 开关 


拔 到 正常 侧 , 电源 开关 打开 ON 后 , 从 微机 传 来 下 述 文 字 : 


mr ery NN 
See cade e 


根据 菜单 的 指示 , 从 键盘 上 输入 1~9 的 数字 后 , 便 被 送 入 微机 处 理 。 

2. 以 左 脚 在 前 为 前 提 

前 进步 行 和 后 退步 行 都 是 以 左 脚 在 前 为 前 提 执 行程 序 的 , 所 以 当 右 肢 
在 前 时 要 输入 数字 1。 

也 就 是 说 , 要 使 左 脚 、 右 脚 都 可 以 在 前 的 话 , 还 要 追加 能 判断 哪个 脚 在 
前 的 函数 (在 demo.C 文 件 中 , 可 以 下 载 ) : 用 menu 选 择 9, 移 向 步行 程序 的 
Imenu2。 


左 脚 在 前 的 状态 下 , 从 menu 中 输入 数字 9, 于 是 , 显示 出 “menu2”: 
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3. 进 行 前 进步 行 

输入 数字 13s 后 , 开始 前 进步 行 。 在 等 待 的 3s 里 , 把 连接 计算 机 和 微机 的 
电线 拆 掉 , 便 看 到 一 边 倾斜 重心 、 一边 向 上 抬 起 向 前 迈 出 的 脚 进 行 直线 前 进 
的 双 足 步行 的 样子 了 。 输入 数字 2 的 话 , 则 进行 后 退步 行 。 

4. 改 变 步 数 

把 程序 中 的 walk_zensin(3) 变 成 walk_zensin(5) 后 ， 便 可 以 把 3 步 的 
前 进步 行 变 成 5 步 。 

walk_zensin(3) 中 的 () 内 的 数字 , 在 程序 中 是 指 步 行 的 次 数 ，(3) 是 
32, (5) 是 5 步 。 

5. 双 重心 倾斜 进行 调整 

开始 之 前 , 先 要 参考 P144 “不定 值 区 的 避免 方法 @O”。 

当 重 心 倾斜 过 大 或 过 小 时 , 要 改变 TYURITU+35 或 TYURITU-20 的 
部 分 (在 程序 中 函数 keisya_hidari () 和 keisya_migi () 中 ) , 

尤其 是 当 重 心 倾斜 过 小 时 , 重心 不 能 充分 移动 , 向 前 迈 出 的 脚 在 抬 不 起 
来 的 情况 下 进行 3 步行 , 因此 不 能 达到 直线 步行 。 

在 步行 情况 很 好 的 情况 下 , 也 可 以 把 重心 倾斜 调 小 试 一 试 。 从 实验 中 可 
知 , 此 时 是 不 能 很 好 地 进行 重心 移动 的 。 比 如 , 可 以 把 TYURITU+35 恋 成 
TYURITU+10、 把 TYURITU-20 变 成 TYURITU-10 看 看 , 步行 的 一 定 
是 向 前 迈 出 的 脚 没 有 拾 起 来 。 

6. 调 节肢 位 置 的 判定 值 

和 上 述 相 同 , 请 参考 P138“ 不 定 值 区 的 避免 方法 @”。 

有 可 能 脚 的 位 置 和 重心 倾斜 的 时 间 不 合 , 也 会 也 现 向 前 迈 出 的 脚 抬 不 起 
来 而 使 机 器 人 倒 下 的 情况 。 此 时 要 调节 脚 位 置 的 判定 值 , 可 以 改变 下 列 数 ， 


例如 , 从 右 脚 刚 接地 时 的 位 置 开 始 到 左 脚 向 前 迈 出 之 前 , 右 脚 都 是 在 前 
方位 置 的 。 右 脚 的 动作 看 上 去 并 没有 太 大 变化 , 但 旋转 传感器 的 数值 却 变化 
了 很 多 。 


5.6 用 微机 自动 控制 进行 步行 实验 155 


这 可 以 按 以 下 方法 进行 确认 :从 “MENU” 中 输入 数字 1, 使 脚 开 始 动 
作 ; 再 输入 7, 使 传感器 的 数值 显示 出 来 。 

MIGIMAE 和 HIDARIMAE 的 值 是 有 幅度 的 , 也 可 以 说 有 改变 的 
余地 。 因 此 , 如 果 要 对 程序 进行 改良 , 可 以 在 前 进 和 后 退 上 考虑 改变 
MIGIM AE 和 HIDARIMAE 的 数值 。 


以 上 为 前 进 和 后 退 的 实验 , 也 用 从 下 载 的 程序 进行 转弯 的 实验 。 


也 可 以 试 着 改变 程序 或 者 重新 做 一 个 新 脚 来 试 一 试 , 充分 体会 由 微机 
控制 双 足 步行 机 器 人 的 乐趣 。 


1 
; o 


hii 
wit 
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加， 制作 接近 于 人 的 
双 足 步行 机 器 人 


在 前 5 章 中 ， 制 作 了 可 以 进行 微机 控制 的 双 足 步行 机 器 人 ， 但 是 
与 人 的 行走 相 比 还 远 远 不 够 。 人 类 在 数 百 万 年 前 开始 步行 以 来 ， 就 
人 在 高 低 不 平 的 道路 上 奔跑 ， 在 泥 淋 的 道路 上 行走 了 。 如 何 才能 制作 
出 更 授 近 于 人 的 机 器 人 呢 9 虽说 日 本 双 足 步行 机 器 人 的 开发 位 于 世 
办 的 前 端 ， 但 还 远 远 不 及 人 的 行走 。 为 了 能 实现 像 人 那样 的 行走 ， 
进行 了 各 种 各 样 的 探讨 。 
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6.1 联 杆 结构 的 界限 


本 书 中 的 双 足 步行 机 器 人 , 为 了 降低 制作 成 本 以 及 容易 控制 , 用 联 杆 结 
构 实 现 了 步行 动作 , 如 图 6.1 所 示 。 


@ 
0 0) 
O 
@ 
0 0 
mf . 成 本 低 
~ X ps M 
LE) A + 联 杆 结构 的 机 械 动作 优美 
9, T 缺点 
o * 不 能 用 脚 进行 细致 的 动作 
@ 
® oo 
o oyo © 
9 @ 
o @ @ 
i VA 


图 6.1 用 联 杆 结构 实现 步行 的 机 器 人 


在 第 2 章 的 “实验 .理解 ”中 提 到 过 , 掘 土 机 的 吊 桶 就 是 进行 反复 挖 土 、 
运 土 动作 的 联 杆 结构 。 联 杆 结构 通常 被 用 在 进行 反复 规定 动作 的 地 方 。 

在 本 书 中 进行 双 足 步行 动作 的 联 杆 结构 , 优点 是 可 以 进行 完整 的 步行 
动作 , 缺点 是 不 能 控制 细小 的 步行 动作 。 因此 , 只 用 联 杆 结构 构成 的 双 足 步 
行 机 器 人 是 有 局 限 性 的 。 

如 果 想 让 机 器 人 在 不 平 的 道路 上 行走 或 者 息 坡 、 上 楼 梯 , 通常 的 步行 动 
E 就 要 增加 使 腿 倾 斜 及 能 调整 抬 脚 的 角度 、 SE, 向 前 伸手 等 很 多 动作 ， 

这 些 只 用 联 杆 结构 是 不 能 实现 的 。 

那么 , 到 底 有 何方 法 可 以 不 完全 依靠 联 杆 结构 呢 ? 

目前 正在 研究 开发 的 双 足 步行 机 器 人 中 , 考虑 了 各 种 各 样 的 方法 来 实现 
WE AE AT, 但 每 种 方法 都 使 用 了 很 多 电机 , 从 而 使 各 个 关节 活动 自如 的 。 也 
就 是 说 , 不 光 是 联 杆 结构 本 身 的 问题 , 还 要 对 脚 、 腰 、 膝 、 手 、 颈 的 动作 进行 
控制 。 
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6.2 增加 能 自由 活动 的 关节 


如 果 在 足 部 、 膝 、 腰 上 设置 电机 , 就 可 以 使 各 个 关节 自由 活动 了 。 
图 6.2 是 双 足 步行 机 器 人 腿 部 电机 配置 的 例子 , 脚 部 配 有 2 个 电机 , 膝 上 
1 个 , 腰 上 3 个 。 这样, 在 一 只 腿 上 共 使 用 了 6 个 电机 , 双 腿 就 要 使 用 12 个 。 


腰 电 机 @) —> | 
腰 电 机 @) 一 一 > (|o| (oO 
腰 电 机 Q@ 一 一 > | 到 | = 
man 一 > j L] . 脚 电 机 GD 使 腿 向 前 后 倾斜 
-HAIS 使 腿 向 左右 倾斜 
AREAL TAUER 


* 腰 电机 GD 可 使 腿 向 前 后 伸 出 

足 电机 @ o o ERNO 可 使 腿 向 左右 倾斜 
ERNO 可 使 腿 转 栖 

足 电机 QD 一 一 > 


图 6.2 腿 部 的 电机 配置 


如 果 使 机 器 人 的 左 腿 膝 部 弯曲 且 上 抬 的 话 , 则 变 成 图 6.3 的 样子 。 


(a) 从 正面 看 (b) 从 斜 前 方 看 
图 6.3 左 腿 上 抬 时 各 关节 处 电机 的 样子 
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要 使 各 个 关节 按照 各 自 的 目的 动作 , 有 以 下 3 种 方法 。 
1. 由 电机 的 转动 角度 控制 姿势 
先 确定 各 电机 的 转动 角度 , 再 按照 角度 转动 电机 , 以 决定 整体 的 姿势 。 


(oy < 一 把 腰 电 机 @ 向 右 转 动 3 
~ J 


=, 


< 一 把 腰 电 机 Q@ 向 右 转动 40° 


过 
we <— 把 脚 电机 OD 向 左 转动 30 


让 = 一 


一 一 一 一 
———— 


图 6.4 确定 各 电机 转动 角度 


2. 由 “指点 ”控制 姿势 

操作 人 直接 用 手 摆好 各 关节 的 位 置 , 再 用 传感器 检测 出 各 电机 的 转动 
角度 , 以 决定 整体 的 姿势 。 

介绍 一 个 简单 的 例子 , 先 使 双 足 步行 机 器 人 处 于 “指点 ” 调试, 再 用 手 
移动 各 关节 , 成 为 图 6.5 的 样子 。 


+ 右 腿 的 腰 电 机 向 右 转动 3° A 
- 右 腿 的 脚 电 机 人 向 左 转 动 2。 

- 左 腿 的 腰 电 机 @ 向 右 转动 3。 

+ 左 腿 的 腰 电机 人 向 右 转动 40。 

+ 左 腿 的 膝 电 机 向 右 转动 90° 

+ 左 腿 的 脚 电机 向 左 转 动 35° 

这 样 ， 从 安装 在 各 关节 电机 上 的 传感器 上 
传 来 以 上 信息 ， 然 后 把 此 状态 保存 下 来 。 


= 


图 6.5 由 “指点 " 调试 进行 的 姿势 控制 
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3. 由 逆 运 动 学 进行 姿势 控制 

确定 某 部 位 的 位 置 后 , 再 计算 该 部 位 达到 此 位 置 时 其 他 电机 需要 转动 
的 角度 , 以 决定 整体 的 姿势 。 这 种 方法 称 为 逆 运 动 学 。 使 用 这 种 方法 , BA 
有 大 学 水 平 相关 的 知识 。 


当 把 脚 的 前 端 位 置 指定 为 这 里 时 ， 
由 计算 机 计算 出 其 他 各 关节 电机 所 
要 转动 的 角度 。 


图 6.6 由 道 运 动 学 进行 姿势 控制 


无 论 何 种 方法 , 就 双 腿 来 说 , 必须 要 决定 12 个 电机 的 位 置 。 在 实际 的 步 
行 中 , 还 必须 与 上 身 的 动作 保持 平衡 , 这 样 就 必须 要 控制 将 近 20 个 电机 。 

使 用 动作 编辑 程序 软件 , 可 以 从 计算 机 的 画面 上 指定 各 关节 电机 的 转 
动 角度 。 也 可 以 用 此 软件 组 编程 序 , 由 程序 确定 各 个 电机 的 转动 角度 , 以 实 
现 双 足 步行 机 器 人 的 步行 动作 。 

对 于 更 高 难度 的 控制 , 不 光 要 使 电机 转动 到 指定 位 置 , 还 要 根据 传感器 
数值 大 小 来 调节 电机 的 转动 角度 , 有 时 还 要 根据 所 需要 的 腿 部 位 置 来 计算 
出 电机 的 转动 角度 等 , 以 此 来 控制 双 足 步行 机 器 人 。 


6.3 用 陀螺 仪 传感器 控制 姿势 


双 足 步行 机 器 人 在 行走 时 , 即使 很 小 的 物体 也 可 以 把 它 绊 倒 , 因为 这 个 
物体 具有 使 它 的 身体 转动 的 作用 。 

当 这 个 具有 转动 作用 的 力 很 大 时 , 就 必须 要 使 机 器 人 伸 出 腿 或 手 了 。 但 
是 当 此 力 较 小 时 , 如 果 能 有 陀螺 仪 传感器 检测 , 再 控制 它 向 反方 向 转动 的 
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话 , 就 可 避免 机 器 人 倒 下 。 陀螺 仪 传感器 是 测量 角速度 的 传感器 , 角速度 也 
就 是 转动 速度 。 转动 速度 为 0 时 , 机 器 人 不 会 倒 下 ; 如 转动 速度 不 是 0, 说 明 
有 转动 的 力作 用 。 根据 这 个 力 的 大 小 使 电机 向 相反 方向 转动 , 就 可 以 避免 机 
at ATK BIT 

以 第 2 章 的 “实验 "理解 ”中 的 纸板 人 为 例 , 如 果 在 塑料 夹 的 位 置 处 设 
置 电机 的 话 , 当 快 要 向 右 倒 下 (转动 ) 时 , 从 电机 上 和 输出 向 左 转 动 的 力 , 就 可 
以 防止 纸板 人 倒 下 了 。 如 图 6.7 所 示 。 


图 6.7 用 陀螺 仪 传感器 控制 倾斜 


现 以 无 线 电 控制 用 的 陀螺 仪 传感器 GWS (中 国 台湾 制 ) 的 GW/PG03 为 
例 加 以 说 明 ( 秋 目 电子 通商 贩卖 , 3400 日 元 ) 。 

此 陀螺 仪 传感器 是 连接 在 无 线 电 控 制 的 伺服 电机 上 使 用 的 。 本 来 从 输 
人 和信 端子 输入 的 信和 号 由 R/C 接收 机 输出 后 用 于 驱动 伺服 电机 , 但 用 于 控制 机 
an ABS, 要 先 从 微机 上 输入 一 定 的 伺服 信号 (例如 , 周期 为 20ms, 脉 宽 为 
1.5ms 的 信号 ) , 如 图 6.8 所 示 。 


1.Smsec 1.5msec 1.2ms 
1 


20ms 
输出 信号 


20msec 


输入 信号 i => 


图 6.8 GW/PG03 的 输入 信号 和 输出 信号 
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被 输出 的 脉冲 幅度 是 根据 转动 速度 而 变化 的 , 由 于 这 些 都 是 由 微机 来 
读 取 的 , 因此 能 检测 转动 速度 、 控制 姿势 。 


6.4 静 步 行 和 动 步行 


在 第 1 章 的 图 1.1 中 , 对 人 步行 的 基本 姿势 进行 了 解析 : 


另外 , 在 第 2 章 的 “实验 .理解 ”曾经 做 了 用 塑料 夹子 使 厚 纸 人 形 立 起 来 
的 实验 。 通过 这 个 实验 , 使 我 们 明白 了 : 


本 书 机 器 人 双 足 步行 的 基本 原理 是 


这 种 步行 称 为 静 步 行 。 但 很 多 情况 下 双 足 步行 机 器 人 的 步行 是 动 步行 ， 
即 机 器 人 重心 的 正 下 方 没有 着 地 脚 (支撑 区 ) 。 

图 6.9 是 本 书 的 双 足 步行 机 器 人 的 示意 图 。 为 了 把 向 前 迈 出 的 右 脚 抬 起 来 ， 
在 重心 的 正 下 方 必须 要 有 着 地 的 脚 (支撑 区 ) 。 因此, 只 有 使 上 身 倾斜 、 移动 重 
b, 始终 在 重心 的 正 下 方 保持 有 着 地 脚 (支撑 区 ) 的 存在 , 才能 进行 步行 。 


| 在 重心 的 正 下 方 有 
= | 着 地 脚 (支撑 区 ) 


Ls 


图 6.9 静 步 行 时 上 抬 一 只 脚 
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在 动 步行 的 情况 下 , 当 上 抬 一 只 脚 时 , 在 重心 的 正 下 方 即使 没有 着 地 肢 
(支撑 区 ) 也 能 步行 。 现 以 左右 重心 移动 为 例 , 说 明 动 步行 是 怎样 的 步行 。 

1. 动 步行 是 利用 了 重力 和 惯性 力 的 步行 

动 步行 中 巧妙 地 利用 了 作用 在 机 器 人 身上 的 重力 和 惯性 力 , 从 而 使 机 器 
人 步行 。 机 器 人 动作 时 要 进行 加 速 或 减速 , 此 时 的 作用 力 为 惯性 力 , 在 第 3 章 
和 第 5 章 中 也 许 会 遇 到 这 种 情况 。 对 双 足 步行 机 器 人 进行 控制 时 , 即使 电机 
停止 了 , 重心 倾斜 并 没有 马上 停止 , 以 至 于 使 重心 过 度 倾斜 。 这 也 是 惯性 力 
的 作用 。 

2 .重力 和 惯性 力 的 合力 方向 与 地 面 的 交点 为 目标 ZMP 

巧妙 利用 重力 和 惯性 力 使 重心 移动 的 情况 如 图 6.10 所 示 , 箭头 的 长 度 
表示 力 的 大 小 , 箭头 的 方向 表示 力 的 方向 。 

惯性 力 的 方向 为 水 平方 向 , 重力 的 方向 向 下 , 所 以 两 力 的 合力 作用 在 和 余 
方向 上 (惯性 力 和 重力 的 箭头 组 成 的 四 方形 的 对 角 线 上 ) 。 这 个 斜 线 和 地 面 
的 交点 称 为 目标 ZMP。 


we 
人 O ; 
目标 ZMP 目标 ZMP 目标 ZMP 


(a) 惯 性 力 小 (b) 惯 性 力 中 (c) 惯 性 力 大 
图 6.10 动 步 行 的 重心 移动 


3. 在 目标 ZMP 内 , 惯性 力 和 重力 的 合力 与 地 面 反 力 相 平 衡 
如 图 6.11 所 示 , 在 目标 ZMP 中 , 有 地 面 反 力 的 作用 , 地 面 反 力 与 惯性 力 
和 重力 的 合力 的 方向 和 大 小 以 及 转动 的 力 都 相互 平衡 . 因为 平衡 , 所 以 机 器 


6.4， 静 步行 和 动 步行 167 b 
人 不 会 倒 下 。 


É 四 边 形 
i 地 板 反 力 是 由 地 板 
摩擦 力 产生 的 


(b) 地 面 反 力 
图 6.11 合力 和 地 面 反 力 


地 面 反 力 是 机 器 人 不 倒 下 行走 的 非常 重要 的 力 。 因 地 面 有 摩擦 , 故 行走 
刚 开 始 时 就 产生 了 此 力 。 如 果 地 面 象 冰 那样 光滑 的 话 , 就 不 会 产生 摩擦 力 ， 
机 器 人 就 要 倒 下 。 

4. 目 标 ZMP 如 果 有 着 地 脚 ( 支撑 区 ) , 行走 时 就 不 会 倒 下 

如 图 6.10 所 示 , 目标 ZMP 如 果 有 着 地 脚 (支撑 区 ) , 双 足 步行 机 器 人 行 
走时 就 不 会 倒 下 。 例如 , 在 图 6.10 (b) 和 (c) 中 , 重心 正 下 方 的 点 偏 高 于 着 
地 脚 , 如 果 是 静 步 行 的 话 , 机 器 人 就 会 倒 下 。 此 时 巧妙 利用 了 惯性 力 , 使 目标 
ZMP 在 着 地 脚 (支撑 区 ) 内 , 因此 机 器 人 行走 时 不 会 倒 下 。 

5. 调 整 惯性 力 和 机 器 人 的 动作 , 使 目标 ZMP 在 着 地 足 (支撑 区 ) 内 

由 图 6.10 可 以 看 出 : 由 于 调整 了 惯性 力 , 目标 ZMP 可 以 始终 处 于 着 地 脚 

(支撑 区 ) 内 。 

在 6.10(a) 中 , 机 器 人 的 重心 在 开始 向 左 移动 的 时 候 , 向 右 的 惯性 力 虽 然 
很 小 , 但 足以 把 目标 ZMP 带 到 着 地 脚 (支撑 区 ) 内 。 

在 6.10(b) 中 , 机 器 人 的 重心 向 左 加 速 移动 , 向 右 的 惯性 力也 稍微 变 大 
了 , 但 仍然 可 以 把 目标 ZMP 带 到 着 地 脚 (支撑 区 ) 内 。 

在 6.10(c) 中 , 机 器 人 的 重心 向 左 加 速 移动 到 最 大 , 在 重力 的 正 下 方 没有 
着 地 脚 (支撑 区 ) , 但 由 于 有 方向 向 右 的 较 大 惯性 力 , 故 也 可 以 把 目标 ZMP 
带 到 支撑 区 。 

以 上 对 双 足 步行 机 器 人 的 左右 动作 进行 了 分 析 。 至 于 前 后 的 动作 , 道理 
也 是 相同 的 。 
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| 


不 过 , WE EAT BLAS A ET Be BA E PE A, A TY PE JS 
平 , 有 时 是 斜坡 …… 在 这 样 的 道路 上 步行 时 , 目标 ZMP 有 时 会 偏离 支撑 区 
而 使 机 器 人 倒 下 。 这 种 情况 下 , 如 果 想 办 法 使 它 在 脚 踏 地 时 伸 开 腿 或 者 使 身 
体 倾斜 , 做 我 们 在 日 常生 活 中 做 的 动作 的 话 , 机 器 人 就 不 会 跌倒 而 持续 步行 
Te 
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